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ABSTRACT 



Library 

Postgraduate 
Monterey, CaMor 



r. 



A theoretical study of the Replenishment at Sea 
Maneuver, on the basis of mathematical modeling and digital 
simulation techniques is carried out. 

Concepts of Linear Multivariable Systems Theory are 
introduced to implement actual modeling techniques. A 
mathematical model of a one plant -tvto ship system with 
multiple inputs and outputs is developed. 

Risk of collision during the Approach Phase is the 
primary consideration. A thorough analysis of the ships 
natural behaviour under differing initial conditions is 
accomplished, thus establishing points of collision. 

An Automatic Station Keeping Control System, which 
guarantees safety and precision during the maneuver is 
designed and succesfully tested. 



4 



TABLE 0? CONTENTS 



I. INTRODUCTION 8 

II. EQUATIONS OF MOTION 9 

A. MATHEMATICAL MODEL OF A SURFACE SHIP 9 

1. Equations of motion for a ship 

moving in the horizontal plane 11 

2. Linearization through Taylor's 

series expansion 12 

3. Nondimensionalization 13 

4. Computer simulation 18 

5. Controllability and stability of 

the linear model 21 

6. The transfer fancrions 24 

B. TWO SHIPS UNDER FORCE FIELD EFFECT 26 

1. Computer simulation 28 

2. Open loop test . 31 

III. THE AUTOMATIC CONTROL SYSTEM ... 33 

A. THE MULTIPLE INPUTS, MULTIPLE OUTPUTS 

PLANT 33 

1. Transfer function matrix type 

number 37 

2- Steady state decoupling ................... 41 

B. THE CLOSED LOOP SYSTEM 44 

1. Generalization of the multivariable 

system desired performance 45 

2. The controlled plant equations 46 



5 



IV. A NEW OPTIWIZ ATION CRITERIA 48 

A. TRIAL AND ERROR PROCEDURE FOR 

QUASI-OPTIMIZATION 0? THE GAIN PARAMETERS 48 

B. TRIAL AND ERROR PROCEDURE RESULTS 49 

V. CONCLUSIONS 51 

FIGURES 52 

COMPUTER PROGRAMS 90 

LIST OF REFERENCES 120 

INITIAL DISTRIBUTION LIST 122 



<• 

o 



ACKNOWLEDGMENT 



The author is sincerely grateful to Dr. George J. Thaler 
for his professional guidance and dedicated counsel in the 
performance and accomplishment of this work. 

A very special word of appreciation to Norma, my wife, 
who together v/ith our sons was an invaluable source of 
strength and perseverance. 

Finalmente, a la Marina de Chile, mi eterna gratitud. 



7 



I* INTRODUCTION 



Replenishment at sea, has become a coinnton and necessary 
practice in almost all the navies of the world. 

Underway replenishment as it is understood today, 

implies the operation of at least two ships steaming at 

close proximity. Experience and studies over the years have 
shown that when doing so the ships must withstand 

hydrodynamic Forces and Moments that tend to alter their 

dynamics creating situations that involve the risk of 
collision. Knowing this fact it is of pure logic to think of 
some automatic device that could prevent and compensate this 
hydrodynamic phenomena. Unfortunately, the data available 
today do not assure a complete understanding of it. This 
limitation does not mean that such automatic system must be 
seen as impossible; the matheraatical model of a ship 
developed by Abkowitz [ i ], gives the chance to include these 
forces and moments as enviromental forcing functions. 

Engineer's studies have ranged from the simple case 



where the dynami 


c of one 


ship 


without 


external forcing 


functions is 


inv 


olved to 


more 


complex 


ones where the 


dynamics of 


two 


ships are 


cou 


pled by 


the interactive 


effects . 












The most 


rec 


ent one £ 


8 ], 


which was 


used as starting 


point for this 


wor 


k, treated 


two 


ships St 


earning at close 


proximity as 


o 


ne system 


of 


mult ivari 


able inputs and 



multivariable outputs, and it developed a reliable automatic 
control systera that allowed both ships to keep their 
irelative stations during the replenishment maneuver. 

This vfork, investigates the posibility of improving the 
above mentioned control system in order to increase its 
capabilities to the general and more desirable situation 
where the automatic control system starts operating at the 
Approach Phase. 
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II* 12 NATIONS OF MOTION 



A. MATHEMATICAL MODEL OF A SURFACE SHIP 



The derivation of a cia theraatical model representing the 
steering and maneuvering of a surface ship in open water is 
given by Abkowitz [ i ]. In its general form, the model 
accounts for non-linear, as well as linear effects. 

Bodies moving in a fluid medium are free to move in six 
degrees of freedom. In order to define the equations of 
motion, a right hand rectangular coordinate system is 
established, the origin of which is chosen to be in the body 
itself, as shown in Figure II-l. The origin and the axis are 
fixed with respect to the body but movable with respect to 
another system of coordinates axis fixed in space; it is 
assumed that at time t=0 (initial tine of the problen) both 
systems coincide. 



mtraighc lorwaiid Nev/toriian Mecharircs Lav.'s of 



T 



\ ^ 4 - 4 



■f 



rigid body can be written as two equations -one a force 
equation and the second a moment equation. The equations 
are: 



d (momentum) 

(external forces) Fe= — 

dt 

d (angular momentum) 

(external moments) Ee= — 

dt 

(II-1) 



The equations describing the 
freedom have been found [ 1 ] to be: 



ship ' s 



six degrees of 



x=m[ U-RV + Q?J-X (R2-iQ2) -!-y (PQ-R) -!-Z, (PR-5-Q) ] 

G G G 

Y = m[ V-PU+RO-I X (R+PK)-y -t 'A (PQ-P)] 

G G G 

Z--in[ i'i-QU•^PV^->: (PR-Q)-M (P+QR) -Z^ (Q2 + p2) ] 

G G G 
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L=PI. + (I -I ) QH+tn[ y (W-QU+PV) -Z^ (V-PW + BU) ] 

M=QI^ + (I. -I ) PB + tn[ (U-RV + QH) -X^ (W-QU + PV) ] 

N=RI, + (I -I, ) PQ + m[ (V-PW + RU) (U-RV + QW) ] 



(II-2) 



(where the notation U=^U/5t is used) 
Satisfying the following equations; 

Fe=iX+ jY+kZ 

Jle=iL+jH + kN 

and where the symbols used stand for: 



m 


Mass of the ship. 


X,Y,Z 


Components of force in the x, y, z directions. 


L,H,N 


Components of moment about the x, y, z axis. 


U,V,W 


Components of velocity in the x, y, z, directions, 



Xg , Y^ , Z^ Distances from the center of gravity to the 
origin in the x, y, z directions. 



P,QrR 


Components of the angular velocity about the x, 
y, 2 axis. 


T T 


Moments of inertia about the x, y, z axis. 



Equations II-2 describe the reaction of the rigid body to 
applied forces as a function of the geometric and physical 
characteristics of the body itself. They do not include any 
of the applied external forces such as propeller thrust, 
rudder forces, moments and forces due to the fins (if any) , 
reaction forces of the fluid (liydrodynamic forces) , and 
waves and wind forces. 
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1 . 



Eg u ati o ns of motion for a §hi£ moving in the 
hor izon tal pl ane 



Normally, when dealing with steering and 
maneuvering of surface ships in open water, the primary 
motions are considered to take place in the horizontal 
plane, and vertical motions are neglected. As this is also 
the case of interest, where only horizontal motions are of 
concern, the equation in Z, the vertical force equation can 
be dropped. Onder the assumption of calm waters, roll, pitch 
and heave are all negligibles, i.e., 

p=p=Q=Q=W=W=0 



Hence equations II-2 reduce to 



X=m[ U-RV-X^3-Y^ R ] 
y=m[ V + UR + X^ R-Y, R ] 

& G 



H=RI, -Jnirx {VtRU)'-Y i 



/ j 



(II-3) 



and assuming the coordinate axis origin placed at the center 
of gravity, X^^Y^. =0, equations II-3 become 

X=m[U-RY], surge 

Y=m[V+UE3, sway 

N=RIj , yaw 

(I I- 4) 

The left hand sides of equations II-4 represent the 
forces and moments along and about the coordinate axes, and 
the right hand sides show the corresponding dynamic 



1 1 



reaction . 










f ' 'jy. 
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2.^ Li n eariza t ion through Taj^lorj.s series expa ns ion 

The forces and moments on the left hand side of 
equations II-l through II~4 can be expressed as properties 
of the body, properties of the fluid and motion. 

Since steering and maneuvering are of interest, 
forces and moments are also considered as function of rudder 
(control surface) deflections and the change in r. p.m of the 
propeller shaft, furthermore, for a surface ship moving on 
the horizontal plane no forces or moments are due to 
orientation changes. Hence: 

(X,Y,M)^f (u,r , V, u,r,v,^ ,§,An,etc) 



(II-5) 



In general it is possible to linearize a 
f (X) by the use of Taylor's series expansion, thus 



f (X) =f (Xp 



,hx ' Bk.) 

’ll >1 



a." 

n! 



function 



where Ax=x-x . For small values of x the second order terms 
0 

can be neglected and thus considering only the following 
expression for f (x) : 

f <x)=f(x^)+Ax^^ 



(II-6) 



The same principle can be applied for small 
perturbations in equations II-5, which is a function of many 
variab3.es. Since the Taylor expansion is v/ritten for a 
pcirticular point, this point is chosen to be an equilibrium 
position. An equilibrium position is that of straiglit ahead 
motion, at constant speed with rudder amidship. The 
hydrodynamic forces and moments have been found to be: 

X=X,, u-«X v>X r + X. u+X. v + X- r + X.f +X. An 
u vruvr^n 

where Au=u-u. and An=n-n and the subscript 0 is referred to 
the values of the variables at the initial equilibrium 
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condition and where all the partial derivatives are 
evaluated. For Y and N similar expressions hold. Equating 
the linearized expression for X, Y and N with equations II-U 
results in the linearized equations of motion for steering 
and maneuvering: 

X Au+X v + X r + X- u + X. v + X. r + X*^ +X £in=mu 

u vruvrdn 

Y„Au + Y^ v + Y^ +Y^ An=m ( v + ru) 

N Au + N v + N r+N* u + N* v + N; r + N.^ +N An=I, r 

(II-7) 

The derivatives X^ , X. , X_. , X. , Xj , Y„ , Y* , , H- , 

vanish for any symmetrical port and starboard shape of ship 
(symmetry about the xz-plane) . This has the effect of 
decoupling surge from sway and yaw. 

Furthermore, considering negligible the effect of 
Ln in Y and N equations, equations II-7 become: 

(X. -ia)u + XAu =-X„An 

(Y. -m) Y^ v+ (Y^ -mu) r+Y- ir=-Yj? 

(N; - I, ) r+N^ r + N; v-4-N^ V 

(II-8) 



3* Nondimens ion al ization 

For computer simulation purposes, equations II-8 
are used \;ith the nondimensional coefficients of a Mariner 
ship, whose characteristics are those of Table 11-2. The 
nondinensional nomenclature is shov?n in Table II-l, and the 
nondj mensiona] coefficients and conversion factors are shown 
in Table II-3. [2,3]. hJ .30 it is of interest to point out 
that the digital computer time frame is in 
nondimensionalized form. 

In order to simplify the notation, no special 
symbols are used for the nondiraensional quantities, being 
understood that only these quantities are of concern. 
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TABLE II-! 



NONDIHENSIONAL NOMENCLATURE 



Symbol 




Def inition 




X’. 


Derivative 


of longitudinal force component 


with 


U 


respect to 


longitudinal acceleration component u. 


X’ 


Derivative 


of longitudinal force component 


with 


U 


respect to 


longitudinal velocity component u 


• 


y» 

V 


Derivative 
respect to 


of lateral force component 

transverse velocity component v. 


with 


V 


Derivative 
respect to 


of lateral force component 

transverse acceleration component 


with 

• 

v. 


Y* 

r 


Derivative 

IT^Sp0Cu. oG 


of lateral force component 

yav angular velocity c'^'nponpnt r. 


with 


A 


Derivative 


of lateral force component 


with 


T 


respect to 


yaw angular acceleration coraponen 


» 

c L *t 




Derivative 
respect to 


of lateral force component 

rudder angle component S . 


with 


V 


Derivative 
respect to 


of yawing moment component 

transverse velocity component v. 


wi th 


N^. 

V 


Derivative 
respect to 


of yawing moment component 

transverse acceleration component 


with 


r 


Derivative 
respect to 


of yawing morcenc component 

yaw angular velocity conponc3nt r. 


v;it h 


K’: 

r 


Derivative 
respect to 


of yawing momeiK component 

yaw angular acceleration coraponen 


uith 

« 

f* >■ 

K. X. O 


kV 


Derivative 
respect to 


of yawing mouert component 

rudder angle component S' . 


wit h 
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I 



x> 

n 



Y’ 

n 



N’ 

n 

r* 

« 

r’ 

U’ 






V 



> 



X’ 



Y’ 



ra» 

u’ 



u’ 



z 



Derivative of longitudinal force component with 
respect to change in propeller r.p.a. 



Derivative of 
respect to change 



lateral force component 
in propeller r.p.m. 



with 



Derivative of yawing moment component with 
respect to change in propeller r.p.m. 

Yawing angular velocity component. 



Yawing angular acceleration component. 



Velocity of origin of body axes relative to 
fluid. 



Transverse velocity component of origin of ship 
axes relative to fluid. 

Transverse acceleration component of ship 
relative to fluid. 

Hydrodynamic longitudinal force (positive 
direction forward) . 

Hydrodynamic lateral force (positive direction to 
starboard) . 

Mass of the ship. 

Velocity of origin of ship's axes along the 
x-axis. 



Acceleration of origin of ship's axes along the 
x-axis. 



Moment of inertia of the ship t ith respect to the 
z-axis. 



t' Time frame. 
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TABLE II-2 



MARINER CHARACTERISTICS AND MAXIMUM VALUES 
OF SELECTED PARAMETERS 



Length, ft 527. 8 

Beam, ft 76.0 

Draft, ft 29.75 

Displacement, tons 16800.0 

Block coefficient, 0.6 

Yaw angle (RAD) 0.26 

Yaw velocity (RAD/SEC) 0.0349 

Suge velocity (FT/SEC) 5.064 

Propeller speed (RPH) 30.0 

Rudder deflection (RAD) 0.35 
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TABLE II-3 



NONDIMENSIONAL HYDRODYNAMIC COEFFICIENTS 
NUMERICAL VALUES AND CONVERSION FACTORS 



Non dimensional 


Nondime nsionalizing 


Nondimensional 


Coefficients 


Factors 


Values*E+05 


(Y’.-mV ) 
r G 


0. S^pL-* 


-27 


u 


0.5*pL3 


-850 


X’. 

u 


0. 5*pL2u 


-120 


Y» 

V 


0. 5*pL2u 


-1243 




0. 5*pL2u2 


270 


(Y’-m') 

V 


0.5*PL3 


- 1500 


(Y* -m') 

r 


0. S’f'pL^u 


-510 


Y 


0. S’f^pL^u 


-351 


N\ 

V 


0. S^pL'* 


-19.7 




0. 5=J=pL3u2 


-126 


X’ 

n 


0. 5*PL3u 


4.62 


Y’ 

n 


0 . 5*pL3u 


-0.52 


ir 

n 


0. 5*pL'^u 


0.26 


V 


0. 5*pl.3u 


0.0 


(N* -nfx’ ) 
r G 


0. 5*pi/»u 


-227 


(N’ -I’ ) 
r z 


0. 5*pLs 


-68 


t ‘ 


L/u 


20.36 



Note: p= Sea water density (1.9905 slug/ft^) 







t 



4. 



C ompute r simu la tion 

If the motion of the ship is to Pe considered under 
external perturbations and with acting controls, no further 
simplifications in equations II-8 are possible. 

Thrust, rudder and fin forces and moments are 
considered control elements, all other forces and moments 
are not normally controllable inputs, but they must be 
included in cases where the ship has to be controlled in 
their presence. To this category belong the interactive 
forces and moments generated in the case of ships in close 
underway replenishment stations. 

Taxing the Laplace Transform of equations II-8 and 
considering the ship steaming in equilibrium conditions 
(i.e., steady forward speed Uq=1) 

V (s) £s (Y; -m) ]+r(s)[sY. +y-m]=-Yy (?{s) 

V (s) [ sK; +N, ]+r (s) [ s (N; -Iz ) -f-H ]— Ns S(s) 

u(s)[s(.X;-m)+X„ ] =-X„n(s) 



(II-9) 

V 

Since r (s) =sl (s) , equations II-9 become: 

_v_(s) [s2 (m-YO-Y, s]^Y(s) [-S2Y; +s(ia-Y, ) ] = Yj ^(s) 

_v(s) [-S2NJ-SN, ]+Y(s) [S2 (I^ -N; ) -sN, ] =NV <?(s) 

s 

_u_(s) [ s2 ( m-X; ) - SX, ] =X„ n (s) 

s 

( 11 - 10 ) 

letting ; 

ail ^m-Y^ 
bJ i=-Y^ 
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c» 1=0 
a 2 i=-y. 
b2i=m-Y, 
c2i=0 
ai2=-N, 
bi2=-N, 
c» 2=0 
a22=i^ -N. 

b22=_N^ 

c22=0 
a33 = m-X; 
b33=-X„ 
C 33=0 



Equations 11-10 can be written as; 



v(s) [aiis2 + biis+cii ]+^(s) [a 2 is 2 -i-b 2 is + c 2 i ]=Yj,5 (s) 



V (S) [ al 2 s 2 + bl 2 s+cl 2 3+i'(s) [ ^ 2 ^ 



]=N J (s) 



U (s) [a33s2 + b33.s+c33] 



=X. n 



(s) 



(11-11) 



setting : 

« 

V (s) =A (s) v=A 

^(s)=B(s) ^1^=3 

u (s) (s) u=C 

IF1 = Yf ^(s) =KA1*D1 
IF2=Nj'(?{s) =--KBl=!-'D1 
IF3 = X„ n (s) =KC1 *DL11 

Equations 11-11 become: 
aiiA^bi iA->.-ci iA+a2iB4-b2iB + c2iB = IF1 



ai2A-j bi2A+ci 2A+a2 2B+b2 2B + c2 2B=iF2 
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a33C + b3 3C + C33C 



= IF3 



or 



a 1 1 A+a2 iB=I1 
ai 2A+a223=i2 



a33c =13 



(11-12) 



(11-13) 



where 

I1=_bi iA-c5 iA-b2iB-c2iB+IF1 



I2=-b52A-ci 2A-b22B-c22B+IF2 



l3=-b33c-c33C+IF3 



Solution of equations 11-13 yields; 





11 


a2i 0 




all 


11 


0 




ai 1 


a2i 11 




12 


d*- u 




ai 2 


12 


0 




ai 2 


a 22 T2 


• • 


13 


0 a33 


• « 


0 13 


a33 


• • 


0 


0 a3 3 



A =■ 



A 



B = 



A 



C = 



A 

(11-14) 



with 



A = 



all aHi 0 

ai2 a22 0 

0 C a33 



=a33 (ai ia22-ai2a2i) 



and replacing the relations between A, C and the original 
variables u, 

A*d t 



• r*' 

V = A= Vq + I Ac 

^=B=^!:j3+jBdt=i’ +Jc BQ-fJ^Bdi ]dt 



u=C=UQ+Jcd t 



(11-15) 
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The transformation from ship to space coordinate 
system is defined by the following relations, obtained from 
Figure II-1: 

Y=u Sin'j/ +v CosV 

X=u Cos!t^ -V Sin'f 



(11-16) 



from which 

Y=Yq +/Ydt 
X = X. +|Zdt 



(11-17) 



Equations 11-13 through 11-17 were translated into 
DSL-360 Computer program I. With a constant rudder 
•deflection I^'=D1=0.1, the results are shov/n in Figure II-2 
(yaw aayl« vt;rsu3 Lime) and Figure II-3 (sway versus snrgp) 
the characteristic turning radius of the ship. It must be 
considered that the described trajectory is valid only for 
small, rudder angles, since linear theory does not give the 
speed reduction in the turn [i ]. 



C ontr olla bi lity and sta bi l ity of the linear model 



These two concepts form a basic background to the 
subject of the qualitative characteristics in the handling 
of ships, since each one takes into account the intrinsic 
properties of a ship and the transfer of initial state of 
motion to another state in a finite time [io]» 

a. Controllability [ 7 ] 

Considering the system 

X (t) =A[ X (t) ,u(t) ,t] for t>t , and x(to)=^ 

(11-13) 
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If there is a finite time >t^ and a control 
u(t), t£[tQ,t, ], which transfers the state ^ to the origin 
at time t^ , the state is said to be controllable at time 

^0 * 

If all values of x are controllable for all t„ , 
the system is completely controllable, or simply- 

controllable. 

Kalman [ 6 ] has shown that a linear, time 

invariant system is controllable if and only if the n*mn 
matrix 

E=r BJABIAB !a"”’b 3 



(11-19) 



I 

has rank n. If there is only one control input (m=1), a 
necessary and sufficient condition for controllability is 
that n*nin matrix £ be nonsingular. 

Taking equations II-8 without including the surge 
equation {because it is decoupled from yaw and sway 
equations) and dropping out the terms containing the 
hydrodynamic derivatives and N; in the yaw and sway 

equations [ 9 ,Pag. 472] only to apply the Kalman Criterion, 
the state equations are: 



* 














- 


V 


_ 


-bi J./a^ 1 


-bzi/aii 


K 


V 




Y 


r 




-bi2/a22 


-b22/a22 




r 




N 


- 










- 


' 





( 11 - 20 ) 



after performing the arithmetic operations 






j;. - 



0027 



-.0012 



-.0018 
-. 0085 ^^ 



which is rank 2, indicating that complete controllability is 
assured. 
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b. Stability 

The stability test determines whether or not the 
ship returns to an established equilibrium condition 
(straight ahead motion at constant speed) , after removing 
the small disturbance which caused its departure from that 
equilibrium . 

A dynamically unstable ship cannot maintain 
straight line motion when the rudder is amidship. 

The behaviour of the ship can be analized by 
considering either some introduced disturbance and zero 
control input (J-0) or the control acting as a disturbance. 

For the first case, and neglecting the surge 
equation, equations II-8 reduce to 

V (s) (a^ 1 s+bi 1 ) +r (s) (a2is+b2i)=0 

V (s) (a^ 2s+bi 2) +J7 (s) (a22s + b22)=o 



( 11 - 21 ) 



yielding the characteristic equation 



ai is+bi 1 
ai 23+51 2 



a2 is+b2i 



= 0 



a22s+b22 



or 



(all a2 2-ai2a2i) s 24 (a 1 1 b 2 a+as 25 ^ ‘ -a 1252 i-a2 1 b^ 2 ) 3 

+ (biib22_bi2b2i)=o 
replacing values and rearranging 
s2-:-0. 685S-M. 01 6=0 



( 11 - 22 ) 

both roots belong to the left half s- plane; the ship has 
fixed control stability with characteristics [ 11 ] 
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C0„ =1.008 
^ =0.34 

Figure II-4 shows the Root Locus corresponding to 
equation 11-22, which is obtained with Fortran computer 
program II. 



6 • The transfer functions 



Defining 
K I i=a 1 1 s2+b 1 ^s 
K 2 i=a 2 is 2 +b 2 is 
Kl2=al2s2+bl2s 
K22 = a22s2 + b2 2s 
K 33 =a 33 s 2 .+b 33 s 

equations 11-11 can be vfritten as 

V (s) Km-Y(s) K2 i = Y^cT(s) 

V (S) Ts. ^ ^ O 

u(sVK33 =X„n(s) 

(11-23) 

solving for v (s) , (s) , u (s) 



J’(s) K 2 1 0 




K»i yvJ(s) 0 




Kii t(2i ^(s) 1 


Ne<‘C^’(s) K2i 0 




K 12 NjJ'(s) 0 




i'l2 K22 Ki‘cT(s) 


X, n(s) 0 K3 3 


U\s)_ 


0 X„ n (s) K33 


tils') .. 


0 0 X„ n (s) 



* s s ■“ 

(II--24) 



where 




Ki 

0 



1 

2 



K 2 i 0 

K 2 2 0 | 

0 K 33 




(K 1 3 K 2 2 



K ^ 2 ^ 2 i ) 



and replacing the K's 
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/\=s (a33 + b33) (; (s 2 (aiia22-ai2a2M +s (a » i b22+a22bi i 
-ai2bi2-a2ib2i)+(biib22-bi2b2i)j 

Evaluating the solutions defined by equations 11-24 

u(s) Ku 
n(s) s+t 

V (s) Kv (s+zv) 

S(s) s2 + ps+q 

^ (s) Kr (s+zr) 

<f(s) s(s2 + ps + q) 

(11-25) 



where 



Yi a2 2-Nr a 2 I 
Kv= 

aiia22-ai2a2i 



Kr=- 



IJjai i-Y^ a 



1 2 






Ku = 



X 



n 



3 3 



b2 2-Kj b2l 

2 v = 

Y^ a2 2-:ij a2i 



Nj bi i-Yj. bi2 

zr= 

ai i-Y^ai2 



b33 

t = 

a33 



a 12b2 2^.j,2 2b “-a^2b2 i-a2 1bl 2 
a i ^ a2 2-a i 2^2 1 



bl Ib22-bl2b21 
aiia22_ai2a2i 



(11-26) 



The transfer functions defined by equations 11-25 
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and 11-26, together with the coordinate transformation given 
by equations 11-16 and 11-17 lead to the block diagram 
representation of the ship. Figure II-5. 

The numerical values for the transfer functions are 
those of table II-4. 



TABLE II-4 

NUMERICAL VALUES FOR THE TRANSFER FUNCTIONS 

Kv= 0.21447 
Kr=-1. 91507 
Ku= 0.00588 
zv= 5.76923 
zr= 1.29369 
p= 0. 68467 
g= 1.01659 
t= 0.14117 



B. TWO SHIPS UNDER FORCE FIELD EFFECT 

The simple case vfhere the equations of notion of one ship 
were derived (II-9) did not take in consideration any 
external field forcing function. 

As it has been previously stated, when tvo ships steam at 
close proximity, the existence of this Venturi type effect 
can no longer be ignored [i ], 

Calvano [ ] using available information and digital 
computer work synthesized the Force and Moment field in a 
set of curves, which can be considered as valuable 
information xn the designing of an automatic station keeping 
control system. These curves are shovm in Figure.s II-6 and 
II-7 respectively. 

The major difficulty in handling these curves is the fact 
that they cannot be written in a simple mathematical form. 
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but the availability of digital computers minimizes this 
difficulty to the point where they can be stored as Discrete 
preknown information (Look-up Table) , this is shown in 
DSL/360 program III, Subroutine Slopes. 

All discussion concerning interaction hydrodynamic 
phenomena, so far, has been for the Mariner which is assumed 
to be ship A of the two ship system, in Figure II-8. 

But hydrodynamic derivatives for both ships, at any 
relative position of interest are needed to write the 
equation of motion for the multivariable system. If the two 
ships are identical the force or moment felt by ship A at a 
given Dx and Dy are the negatives of the force or moment 
felt by ship B at the same Dy at Dx=-Dx [ 4 ]. 

Defining 

Y=?orce in ship A due to ship B 
y=Force in ship B due to ship A 
N=Moinent in ship A due to ship B 
=i'i Ofii en t in siirp B due to ship A 



then 



= -Y 



tnd 



Drr<x 
oy zp 



0i = «. 

D>-p 



=-N 



0 xr - ^ 
Dy 1 a 



Dx rs — Cs;; 
Dr= p 



(11-27) 



where os and |5 represent numerical values in the range of 
interest of the variables Dx and Dy. 

The equations of motion of the tuo ships, coupled now by 
the interactive effects can be viritten as xoilov/s: 



[aiis2 + b» ^s-cii ]Ui(s) [a2is2^-b2is-f ]=Yjo'’^(s) ^ Y,(s} 
_Vl(s) [ai2s^-!b»25+cii^]-!Yi(s) [a22sa+b22s + c22 ]=N^(^^(s) +N,(S) 

s 

_^(s)[alls2 + bils+cll [a2 1s2 + b2 ls+c2 1 ]=Yjcf2(S) +Y2 (s) 
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VjCs) [ al2s2 + b> 2s + cl2 [ a22s2+j322s + c22 ]=N^<f2(S) +^’ 2 ( 3 ) 

s 

Ui(S) [ a3 3sZ»b3 3s-t-c33 ] =X^n,(s) 

s 

J^(S) [ 3s2 + b3 3 s+c33 ] =X^n^(s) 

s 

(11-28) 

in which the coupling effect is implicitly defined ny 
equations II~27. 



1 . Com pu t er si mulation 



So far, the equations of motion of two ships 
coupled by the interactive effects (11-28) are in a neat 
form to be simulated in the digital computer, but it is 
desirable to impose an additional constraint to reflect a 
real limitation. There exists a certain time lag between the 
instant the rudder order is given until the action is 
coiupleted. This time lag is taken as 1 (non 

dimensionali zed time, actual value is 2.08 seconds). Thus 
the rudder order J(s)is modified to take into account this 
time lag. 




1 

str+ 1 




(11-29) 



vjhere 

eld is the desired rudder angle 
n 

0 xs the actual rudder angle 
tr is the time lag 

a. The equation of motion of ship # 'i (leading ship) 
Fros equations 11-28 

vi(s) [ ai is2 + bi is<-c» 1 ]-iS(s) [a2is2 + b2 is-.'-c2i ]=Y^ J^(s) s-Y,(s) 

V^ (S) [ al2sZ-fbi2s + Cl2 ]+\^i(S) [a22s2i-b22s+c22 ] = N^(}'^(S} ■! N,(S) 
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U^(S) [ a3 3^2 + 1)3 3 s+c3 3 ] 



=X„n^(s) 



(11-30) 



Considering the steering control as it is 
described by equation 11-29 



(s) =. 



10 



ii(s) 



s+10 



(11-31) 



and setting 



(s) 

IF1 1 (s) : — +Y,(s) 



0. 1s+1 



IF21 (s) = 



(s) 

0. 1s+1 



+ N,(s) 



(11-32) 



The same procedure followed for the derivation of 
11-12 through can be applied yielding as before 

fbiiA^ -i-ciiA^ +a2iB^ +c^ > =IF11 

ai2A^ +bi2A^ +c12a^ +b22B^ =IF21 



a33c^ +b33c^ -{-C3 3C^ 



= IF31 



(11-33) 



or with 



• • 

111 = ~biiA^ -cJiA^-b2>B, -c 2 2B^ +IF11 
l21 = -bi2A^ ~c12a^ -b22E-)^ -c 22B^ +IF21 
I31=-b33c^ -C33C^ +JF31 



(11-3'!) 



equations 11-33 can be written as 
ai : +a2 i*b‘^ =11 1 

ai2*A^ +a2 2B^ =121 
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I 



= 131 



a33C 



(11-35) 



• » • • 



Solving for and 

a22ii i-a2ii21 .. aiiI21-a»?ni 
A, =• 



B = 

ai Ja22-a»2a2i ’ ai i 



ai ia22-ai2a2i 



> C = 



131 



1 a33 



(11-36) 



and the original variables are recovered as before, 

X dt=Xi i+Js, dt ]dt 

=H)i 



(11-37) 



so that in the space coordinate system 
=u^ SinY^ +v^ Cos^, 

=u^ CosY^ -v^ Sin Y, 

''t 

(11-38) 

b. The equation of motion of ship #2 (trailing ship) 
Since, from equations 11-28, it is seen that 
equations for ship #2 are the same as for ship #1 differing 
only in the subscripts, this derivation is omitted . 

Equation of motion of ship SI and ship S2 were 
translated into DSL/360 digital computer program III. 

A piocevfise linear approximation of forces and 
moments is given by the table look-up and the interpolation 
Subroutine Slopes, A warning message is printed whenever the 
distance between the ships become less than 25 feet. For 
separations greater than 250 feet the ships were considered 
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to be outside of the range of interest and the forces and 
moments assumed to be null. 

2 • i22£ test 

As previously mentioned, the existence of risk of 
collision in the replenishment maneuver is qualitatively 
well known [3] and it fixes the basis for any attempt of 
designing an automatic station keeping control system. 
However a well founded quantitative analysis of this 
particular subject is almost impossible to find in the 
current literature. 

The open loop test presents a quantitative analysis 
of the two ship system behaviour, and by choice of different 
initial conditions it detects the Collision Points. Of 
course, the simulated situation is ideal and thus only 
approximates actual physical conditions. The analysis is, 
however, an excellent approximation to reality. 

The simulation is ideal in the sense that human 
intervention is excluded and only the inherent 
characteristics of the ships in the hydrodynamic field are 
evaluated. 

Table II-5, indicates the tests perforraed to the 
multivariable open loop system using DSL/360 Digital 
Computer Program III. 

TABLE II-5 



Test # 


U1 (0) 


U2 (0) 


Df (0) 


DY (0) 


1 


1 . 


1 . 


0.2 


- 1 . 


2 


1 . 


1 . 


0.2 


0, 


3 


1 . 


1. 


0. 1 


0, 


4 


1. 


1.2 


0.2 


- 1 . 


5 


1 . 


1.2 


0. 2 


0. 
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Note that the actual distance is obtained by 
multiplying the nondimensional length by the length of the 
ship (i.e., 0.2 <=> 0.2*528 feet). 

Figures II-9 through 11-20 show the behaviour of 
the two ships for the conditions pointed out in Table 11-5- 

Three important conclusions are obtained from the 
analysis of the Figures. 

i) The ideal case, where the equilibrium conditions 
are set at abeam posxtion at t=0 and released at t=0 (i.e., 

=0) the combined effect of Force and Moment fields tend 
to pull the ships apart. It is apparent that no collision 
risk is involved (Test 2, 3, Figures 11-12, 11-13, 11-14, 
II- 15) . 

ii) The more realistic case where the equilibrium 
conditions are set at the Approach Phase and then released 
(t=0 ^) , the combined effect of Force and Moment fields tend 
to attract both ships and collision is unavoidable, (it must 
be considered that after t=0 no human action is involved and 
v;hat is observed in Test 1 and 4, Figures II-9, 11-10, 11-11 
and Figures 11-16, 11-17, 11-18 correspond to the natural 
behaviour of the ships) . 

iii) Test 5, figures 11-19 and 11-20, shows the 
Departure Phase, where the speed of ship #2 is allowed to be 
increased and no risk of collision is observed. 



i 
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Ill® THE AUTOMATIC CONTR^ SYST EM 

This section starts with the definition of a plant 
with multiple inputs and multiple outputs and proceeds with 
mathematical derivations until a model for the automatic 
control system is obtained. 

A. THE MULTIPLE INPUTS, MULTIPLE OUTPUTS PLANT 

The initial equilibrium condition for two ships steaming 
at close proximity indicates that an undetermined forcing 
function is required at t^ to compensate the effects of 
F(£vX^, ^^0^ M (AXq , AYq ) which are considered constant. 
This definition is valid only at t =0 since there is not any 
logic that prevents S from changing to another value that 
compensates increments of F and M due to variations of Ax 
and AY. Abkovitz [ i ] has shown that the force or moment 
caused by (change in any variable is expressed a‘= th<^ product 
of the derivative of the force with respect to that variable 
(with all other variables at equilibrium values) and the 
change in the variable. Using this criteria, at t ~0 it is 
required to compensate: 



-bF -^F 

F (Ax, AY) — AX+ — AY 
■?>x y 

and 



H (AX,AY) = — AX + — AY 
'Sx "Dy 



{III-I) 



which represent the "departure" from eguilibrium conditions. 
Defining 

■7) F {AX , AY ) =k i 0 AY+ k 2 o^x 



and 



33 



(aX, AY) =qio^Y + g20^x 



( 111 - 2 ) 



where k^o, k^o^ represent the rate of change of F 

and M with respect to AX and aY measured at AX„ and AY .the 
longitudinal and lateral separations from the established 
equilibrium conditions. 

The linear expression for'^F and must be defined in 
terms of the variables u, v, ^ and then added to the left 
hand side of equations 11-10 under the following 
assumptions: 

a. The two ships are identical. 

b. All hydrodynamic coefficients are not affected by the 
intermingling of the water pressure between the ships, 
therefore remaining constant. 

c. The two ships are considered already as being 
alongside each other (AXq=0). 

d. The forces and moments acting on the ships are equal 
in magnitude and of opposite sign. 

e. The change in forward velocity is considered 
negligible. 

The increments Ax and AY can be expressed as given by 
equations 11-17 




Using equations 11-16 




(111-3) 



For the small perturbations being considered 




Sin'? “aO 
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Cos 



y.1 



SinY 

2 



and equations III-3 reduce to 



-X =:i0 
2 1 






and finally 


cj^ AX(s)^0 
C) 


AXssO 


A^Y^Jcv^ ) dt 


AY {s) =l-(v^ -v^ ) 


The equations 


11-10 are modified 



interaction effects and become 



to include the 



v^(s) [a^ + is + c^i ]+!£,( s) [a2is=5 + b2is+c^i ]+V 2 (s) k = Yj <^(s) 

v,(s) [ai 2 sE^iji 2 s+ci 2 ]+Y,(s) [ a.^ ^ c'^ ^ g = Nj'(^(s) 

s s 

VgCS) [ al * s2 + b^ Is + C^^ i C ^s2-f b2 ls+c2 1 ]+Vi(s) k=Yj o^(s) 

“s ”1 

V2(s) [a^^s^+b‘2s+c’ 2 ]+V(s) r ^ 22 s 2 ^.]) 2 ?.c 3 + q?z q = K;d (s) 



where now 

c^^=-k and c^^=-q 

letting 

plOcral J G2 + bl 2ls + ci 1 
p20 = a21s2 + b2 3s-tc21 
p3 0=a ‘ 2 .s 2 + b^2c;4cl2 
P^0=a22s2+b22s4c22 

equations III-4 become 

J^(3) pio+¥,{s) p2 0+^(s) k=Yj- o^(s) 
Vi(s) p30+^i(s) p-»o+j^(s) g = br^ clj(s) 

s “ s 



(III-4) 



(III- 5) 
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(III-6) 




S 




Equations III-6 show that two ships affected by 
interaction forces and moments can be described as a 
multivariable system where the deflection of the rudders cf, 



outputs of interest. The next following step has as object 
to determine the form of the entries of the open loop 
transfer function matrix ^ (whose model is shov/n in Figure 
III-1), so that the system can be analyzed and modified, if 
necessary, to become steady state decoupled -after a 
transient period of time, a variation introduced in the 
rudder angle of one ship will not alter the yaw angle of the 
other . 

From figure III-1 



an 



d cfj are the control inputs and the yaw 





or 




(III-7) 







g2 i g 2 2 



hence 
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(III-8) 



and evaluating the gains 







0 



so jG(s) must be of the type 



r? 







c^l 






function matrix tvno number 



(III-9) 



Equation III~9 gave the general fora of the Plant 
matrix G^. An explicit expression for the entries of the G 
matrix is not needed. The steady state decoupling of the 
states by means of a compensator matrix requires only the 
knov/ledge of the number of pure integrators in the entries 
of G, this is referred as the type number of the matrix [ 5 ]. 

Solving III-6 for (s) and recalling 

III-8 




[g^^ (r^(s)+g2i 




V, 
1 (; 
2 



3 )=- 



[ g- 



L.< 



) +g'- 



02 (; 



= ) ] 



A 



( 111 - 10 ) 



(III-1 1) 



where 



A = 



pio p 20 k 


0 


p30 p* 0 g 


0 


k 0 pio 


p20 


q 0 p30 


p4 0 


(pl0p4 0-p20p 


30)-( 



(III-12) 

where p'o and are second order polynomials in s 

satisfying 

Lim p?40 
s->0 

Thus the special case of having either k or g 
identically zero is avoided. 

solving for^^(s) in III-6 

TaT (Njpi0-y^p30) (pi0p40~pa0p30) 

d ,(.1 

, (Ytg-Niq) {fcp< 0-gp2 0) 

{Ys p<^0-N<fp20) (kp30-qpt0 ) ^ 

A 

(III-1 3) 

where A is given by equation III- 12. 

fieplacing p^°/ P^°r P^°/ P'"® as indicated by 

equations III-5 and taking separately g^^(s) and g22(s) 

^l(s) M p (a ^ ^ s2 + bi 1 s + c 1 ^ ) (a 22 c; 2 ^. h 22 s + c 22 ) 

g. 1 ( = ) =_iJ ^ L__' 

£, IS ) ^ 

•V' (3 1 1 s'a<-b i 3 s-t c ’ 5 ) { a 3 i s 2 + 1)2 j G !-c 3 1 ) (a*- b 1 - 2 ) 

_ 

(a 1 1 s2 +b 1 ^S + C ^ (a ^ 2s 2+ b 1 23 + c 1 2 J (a2 2s2i-b22si-c22) 



A 
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Yj' (a 2 1 s 2 + b 2 is+c 2 1 ) (a 1 23 2 + j) 1 2 3 +c 1 2 j + qk (a^ + 2 s + c^ 2) 

A 



^q2 (aais2 + b2»S+c2 1) +tyc2 (a2 2s2 + b2 2s + c2 2 ) - J^qk (a2 1s2 + b2 1s+C2 1) 

A 

(III-14) 



and from equations II-IO, 11-11 



C21=c22=0 



then one s can be factored out immediately in the numerator. 
The independent term must be also checked, if it is equal to 
zero, then another s can be factored and so on. 

Replacing c^i by -k, and, c ^2 by -q, the 
independent terra becomes: 

N^k2b2 2-jj^j'gb2 i-y^kqb2 2 + y^ b2 ig2<.y^ qkb2 2 



-iV g2b2 1-N^k2b22<.hi^gkb2 1=0 

which indicates that a second s can be factored out in the 
numerator . 

Expanding the denominator 
^ =s 2 [ (as3 + bs 2 + cs-!-df- (es + d)^' j 
A=s 3[ a2s5 + 2 abs‘^+ (b 2 + 2 ac) s3-!-2 (ad-s-bc) s 2 

•!- (c 2 -f' 2 bd-e) s+ 2 d (c-e) ] 



v/here 



a=ai 1 a22-a2iai 2 

b=bi 1 a22+ai ib22-a2ibi 2 
c=bi ih2 2-Ka2 2^-a2iq-b2ibi2 



d=b2i q-kb22 
e=qn2 i-ka22 



, It can be shown that the independent term never 
goes to zero for the given values of the hydrodynamic 
coefficient of the Mariner [ 9 ]. 



Hence, the highest factorable power of s is s^, and 



gll 




is a type 1 transfer function (i.e. , it has one single pole 
at zero) . 

Expanding the numerator of g^ i (s) 



Ng2i (s) =s[ k (a22s+b22) 23 2 + ^ ^ 23+^1 2 j 



-kH<f (a2is+b2i) (a 1 23 2+b 123+ci 2 ) 



+ N^g (a 1 1 s 2 + bii s + c* 1 ) (a2is+b2i) ] 

and making the same analysis done before for the independent 
term: 



-y^ kgb2 2+y^g]cb22 + K,'j^ b2i g-N>q];b2i=0 

which indicates that the highest factorable power of s is 
s2. Hence g2^^(s) is a type 1 transfer function. 

The solution of equation III- 11 for 'l' 2 (s) -i--' 



TJ (Nj«pi0-Ysp30) (plOp40-p2Cp30) 

¥ 2 ( 3 )= ^ d(s) 



(Y^ g-Ni k) (kp^o-gp20) 



A 



{(S) 



(Y5-p4 0-M^p2 0) {kp30-gpj.0) 

A 



^(s) 



(I II" 15) 



as could be expected by symmetry, sane form as 



Trr 



(s) . 7is a conclusion, the type number matrix rs in 
general 



Tp = 



1 1 



1 1 



(III-16) 



40 



2 . 



Steadjf state decougling 



Once the type number of the plant matrix G has been 
found, interest is concentrated in the determination of the 
cascade compensator matrix. 

An important consideration that must be made is the 
fact that the technique to be used in finding the 
compensator matrix does not assure by itself stability or 
good transient response when the feedback path is closed. 
Figure III-2 shows the closed loop block diagram, where 
is the compensator transfer function and Gp is the plant 
transfer function, and 



^ 

U) 








, C(S) = 











Huang and Thaler [ 5 ], had shown that assuming that 
^ is stabilized through the configuratiori of Figure III-2 
then the system is steady state decoupled if and only if 



for 



lira 

s->0 




(I^GpGc)j, 

det 



all i=-1 



n 



= 0 



(III-1?) 



If Gc is a diagonal matrix and all inputs are steps 
, the compensator type matrix which gives the 

number of integrators required for steady state decoupling 
of a 2=>=2 system is obtained by satisfying the conditions: 

K>0 



( 111 - 18 ) 



hi 



where 



M = HaX[ (tpl l + tcl M , (tp 22 + tc 22 ) , (tpl l + tp22+tcll + tc22) , 

( tpl 2 + tp2 1 + tc 1 1+ tc2 2) ] 

NXZ^tCl l+tp2 I 

N2 X = tC22+tpl2 

(III-19) 

from equation III-16 

tpXX=tp^2=tp2X = t p2 2 = 1 

then 

NX2=tci 1+1 

N2X=tc22+l 

H = Hax[ (tcll + 1) , (tc22+1), (2 + tcl l + tc22) j 

Considering that the plant has four pure 
integrators, no sore are required in the compensator matrix 
then 

tci i=tc22=o 

and 

NX2=N2X=1 



H=2 



satisfying the conditions established by equations III-IS 
From whicJi: 





o 

V 


0 




gll 


0 


Tc - 


( 

o 


0 


, Gc= 


r 

o 


g 2 2 



(III-20) 

By III-16 and with III-20, G will have the same 



type number matrix as 



hence 



T= 



1 

1 



1 

1 



then G can be written as 



r 

(s) 

SP-ii(S) 

pzi (s) 

SPa(S) 



P ^2 (s) 
sP^(s) 

pgg (s) 
3Pa(S) 

J 



where P^. (s) and Pi^i (s) , i,j=1,2 are polynomials in s such 
that 



Lim P (s) 
s->0 

The rang'e of permisible i.nputs is determined by 
means of equation III-18 



pi i (s) <■ sP^i. (s) 
sPa (s) 



I + G= 

/V' ^ 



p^i (S) ^ SP>A (s) 
sPa (s) 



P12 (s) +SPa(S) 

sPa (s) 

P22 (S) +S?A.(S) 
SPa(S) 



det[ I-t-G 3=- 



(pil <S}+SPa(S)) (P22 (s) +sPa(S) ) 



(SP^(S) ) 

(P2 1 {S) -f-P^Cs) ) (P12 (s) +SPa(S) ) 



(sPa (s) ) 



1 1 ■* G ] j 2 

A/ ^ 



p2i (s i- s Pa (s ) 

S.5H^ is) 



U+S]%1 = 



(s) +sPr^(s) 
SPA (s) 



lini 

s ->0 



[I-^G3i,2 J_ 



[I^S]2,l 



det[I+g] det[I+G] 



= 0 



and after simplifications 



lit 



1 (s) pi2 (s) 



— =0 



S ->0 P» 1 (S) P 22 (S) -p 2 Ms) P 12 (s) 

(ki, k2<2) 



(III-21) 

Then the system is steady state decoupled not only 
for step inputs, but also for ramp (k=2) inputs. 

B. THE CLOSED LOOP SYSTL'H 

Theoretically, the steady state decoupling of the outputs 
of the plant matrix has been guaranteed and the order of the 
system kept low because no extra integrators were added in 
the compensator matrix Gc. However there still remains the 
problem of satisfying an adequate performance, which in turn 
is the main purpose of the automatic control system. 

Lima [e] solved this problem by modifying the compensator 
ratrix to the form: 



— 




— N 


(s-( i ) 0 




KUsKTI 0 


0 g22(s + z22) 




0 K2+SKT2 









and satisfied the desired performance, which was iniiially 
stated in section A. 

After an exhaustive analysis of the control system, the 
idea of increasing its capabilities based on the conclusions 
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cooing next was a feasible and attractive prospect. 

i. Existing decoupling in the Surge equations of the 
multivariable system allowed minor changes in their forward 
speeds without appreciable effect in their trajectories. 

ii. Equations 11-27 indicated that no additional 
difficulties were introduced by changing initial conditions 
in the X axis (i. e. , A Xi^O) . 

iii. The gains of the compensator matrix obtained by 
Parameter Optimization Techniques [ e ] allowed different 
damping rates in their transient responses. 

iv. No automatic speed control was required, since minor 
changes in speed of the trailing ship v/ere easily made by 
following the acceleration tables of the ship (i.e., it is 
assumed that the leading ship forward speed is kept 
constant) . 



1 ♦ G^e^lizat i on of the miy^tiyariable sjyste m des ired 

perf orma nce 



Only a few words are enough to describe this 
objective. Reliable vfork of the automatic control system, 
capable of keeping the desired relative positions between 
two ships from the beginning of the replenishment maneuver 
(Approach Phase) to the end of it (Departure Phase) , 
minimizing the risk of collision. Figure III-3 shows the 
general case where both ships maneuver. 

The variables of interest in the control loop are 
Y, / Y,'’ Although DX and D*X are also 
variables that must be controlled, they do not affect in the 
control loop, their action is controlled manually by 
changing the forward speed of ship #2 until DX is reduced to 



zero. 



The 



design procedure is an extension of the work 
presented by Lima [a], in which the ships were initially 
considered steaming alongside at a lateral separation 
greater than that required to perform 



the replenishment 



maneuver. Tne optimal gains as given in Table III-I were 
obtained as result of choosing the desired trajectories for 
each ship and defining a cost function to be minimized. 
These values were kept the same for these studies, however, 
the initial conditions, specifically U20, DX, and Y1 and Y2 
were changed in order to include the Approach Phase. 



2* The co ntrol le d £lant eg na tions 



The block diagram of the controlled plant is shown 
in figure III-4, and the following relations are obtained: 



p 1 [ <KTYls+KYl) Y1 (s) + (KTls + Kl) V(s) 1 

d,i(s) = ' 

trs+1 



(IIJ-23) 



cf 



- (s) = 

trs+1 



1 [ KY2 (DY-DFIh) +KTY2SDY+ (KT2s + K2)^(s) ] 



(III-24) 

where D?IK is the Desired final Lateral Separation. 

The fact that there exists limitations in the 
maximum values of the rudder angles [ 3 ] imposed an 
additional restriction, which is 



|(fl<0.349 or (<20° ); for 1^1>0.349 



11-23 and iI-24 become 



L 



(S) 



1 

*(0.349) 

trs+1 






d2 



(S) 



1 

* (0.349) 

trs+ 1 



(III-25) 



(III-2G) 

Digital computer program #4, vihich is program v3 
modified by including equations III- 23 tnrough III- 25 allows 
us to make the simulation of the multivariable system now 
implemented by the station keeping automatic control system. 



TABLE III-1 



FEEDBACK LOOP GAINS 



Parameter 






Run #1 




Run #2 


U10 






1. 




1 . 


U20 






1.2 




1 . 2 


DY (0) 






o.h 




0.36 


DX (0) 






~ 1 . 




-1 . 


DFIN 






0.24 




0.3 


K1 






2. 975 




3,069 


KT1 






2.775 




3.080 


K2 






2.917 




2.853 


KT2 






2.042 




2.141 


KYI 






3.008 




3.320 


KTY1 






2.783 




2. 555 


KY2 






1.511 




1 . 533 


KTY2 






2.878 




2.608 


figures III 


-5 


through III-10 show 


the computer 


simulation results 


of 


the 


controlled plant 


. Both ships 


reached the desired 


steady t 


rajectories allowing a safe, as 


well as precise. 


maneuver 


, although a 


res 


idual lateral 


separation error exists 


(0.02 <=> approxima 


tely 1 1 feet) , 


which can be easily 


re mo 


ved by indexing 


in 


the hardware. 


Note that these are 


not 


solely I. C. curves 


but 


are tests of 


system behaviour as 


ship 


2 approaches ship 1 


at a forward 


speed 20 A greater than 


tha t 


of ship 1. The 


initial large 


excursion of ship 


1 


is 


due in part to 


the 


large mo non t 



caused by the pressure field, and in p<irt by the chosen 
initial conditions. 



IV« A NEW OPTIKIZ^ION CRITERIA 

The preceeding section led to the final design of the 
automatic control system. A basic assumption vas made in the 
sense that the feedback gains were kept unchanged from the 
optimals obtained by Lima [a]. 

Computer simulation demonstrated that the assumption 
made was good enough to allow the two ship system to satisfy 
the desired performance. However the trajectories can no 
longer be said to be optimal, since completely different 
initial conditions were imposed. To overcome this fact two 
techniques were considered -the first one, to reformulate 
the optimization study incorporating the nev; initial 
conditions, and, the second, to use the actual gains and to 
originate a systematic procedure, basically Trial and Error, 
to determine not optimal, but guasi-optiraal gains. 

Because it was expected that the range of variation of 
the parameters would be reasonably ssall, the second 
procedure was adopted. Of course, the Trial and Error 
procedure has the disadvantage that many statistical 
combinations are ignored, but, on the other hand experience 
gives a high degree of confidence in a systematic computer 
trial procedure. 



A, TRIAL AND ERROR PROCEDURE FOE QUASI-OPTIl’IZATION OF THE 

GAIN PAHA METERS 

Selecting the time basis trajectories shown by Figures 
III-8 and III-9 the new objective is to smooth Suay and i'aw 
transient responses. Note that the same procedure applies 
to Figures III-5 and III-6. 

From Figure III-4, a Procedure Flow Chart was made uhich 
includes all the possibilities of discrete changes in the 
K's parameters in the range 0 to '\Q0% by increasing its 
values. 



h8 




I 



The possibility of decreasing the K‘s values was left out 
because it was esticaated, based on linear theory, that it 
would not meet the requirements. 

Figure IV-1 shows the Trial Procedure Flow Chart. 

From computer simulation, many runs were done using 
DSL/360 computer program #5 but after the selection of the 
"best set", graphs of Run #1 through Run #4 were considered 
important enough to be included for purpose of analysis. 
Note that all of these simulation runs were made with the 
trailing ship approaching the leading ship at a speed 20% 
greater than that of the leading ship. 

B. TRIAL AND ERROR PROCEDURE RESULTS 

Table IV-1 shows the gain parameters for the four main 
runs of the Trial Procedure Flow Chart. Figures IV-2 through 
IV-9 are the computer output for this stepped procedure. 

The decioicn cf the best sot of K's was somewhat 
subjective and based principally on the shape of the 
corresponding computer output curves. A qualitative 
analysis of the Sway and law curves, however, indicates that 
there is a definitely improvement in the smoothness of the 
transient. Figures IV-8 and IV-9 being considered the best 
set, as may be seen by comparison with Figures III-8, III-9. 

Figures IV-8 and IV-S are the most important because they 
assure that the systematic Trial and Error procedure was an 
excellent tool to obtain guasi-optimal gains for the 
specific initial conditions of the Generalized Desired 
Performance described in section III. 
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TABLE IV-1 



FEEDBACK LOOP GAINS FEOH TRIAL PROCEDURE 



Parameter 



U10 

U20 

DY (0) 

DX (0) 

DFIN 

K1 

KT1 

K2 

KT2 

KYI 

KTY 1 

KY2 

KTY 2 



Run #1 
KT1 + 50fo 

1 . 

1.2 

0. 36 

- 1 . 

0. 3 
3. 069 
4.62 
2. 853 
2. 14 1 
3.320 
2.555 
1 • 53 3 
2.608 



Run U2 
KTYI+50% 

1 . 

1.2 
0.36 
- 1 . 

0.3 
3.069 
4.62 
2.853 
2. 141 
3 . 320 
3. 8325 
1 . 533 
2.608 



Run #3 
KY2+25% 

1 . 

1.2 
0.36 
- 1 . 

0.3 
3.069 
4.62 
2.853 
2.14 1 
3.320 
3.8325 
1.91625 
2.608 



Run #4 
K1+15% 

1 . 

1 .2 
0.36 

1 . 

0.3 

3 .52935 
4.62 
2.853 
2.14 1 
3.320 
3 .83 25 
1 .91 625 
2.608 
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V» CONCLUSIONS 



It has been detaonstrated that the intrinsic dynamics of 
ships steaming at close proximity is unstable, the Approach 
Phase of the replenishment maneuver being of particular 
interest, where, excluding human intervention, collision is 
unavoidable. 

•The mathematical modeling of two ships as one system 
with multi-inputs and multi-outputs has proven to be a 
powerful technigue in the study of the dynamic behaviour of 
vehicles coupled by a common media. 

The station keeping control system, initially based on a 
previous concept, was tested under different conditions, 
and, significant modifications were introduced, mainly in 
the gain parameters of the feedback loops, to satisfy the 
aims of safety as well as precision in the whole maneuver. 

To avoid increasing the order of the general system 
equations, nc forward speed control was included, being 
assumed that the forward speed would be controlled manually 
as is actually done. 

Even though the design of the hardware was not intended, 
it is estimated that a fiodular System composed of a Doppler 
Sonar, a Gyroscopic Element and probably a Digital Logic 
would be suitable in its realization. 




Figure II-1. Orientation of the Space Axis (Xo, Yo) 
and the Moving Axis (X, Y) . 
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FIGURE 1 1-2. VRN RNGLE US- TIME. 
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FIGURE 11-12. SWRV US. TIME. TEST #2. 
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FIGURE 11-13. VRU US. TIME. TEST *'2. 
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FIGURE 11-17. VRH US. TIME. TEST «4. 
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FIGURE 11-20. VRU U5- TIME. TEST #5. 
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fjourc IH— 4 The Control loops 
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FIGURE III-?. RUDDER US- TIRE. CONT. PLRNT. 
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FIGURE IU-2. 50F KTl. SWRV US- TIME- 
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FIGURE IU-3. 50R KTl. VRU US. TIME. 
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FIGURE IU-4. EOF KTVl 
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FIGURE IU-5. 50G KTVl, VRW US- TIME- 
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FIGURE IU-6. 25Z KV2- SWRV US- TIME 
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FIGURE IU-7-. 25G KV2. VRW US. TIME. 
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0 '17 DO 'OT 



//ASTOZ JOB ( 1025t0732, EA32 ) , 'ASTORQUIZA' tTIME=4 
// EXEC DSL 
//OSL. INPUT DD * 



♦ COMPUTER PROGRAM I 



« LINEAR RESPONSE OF THE MARINER 



INTEG TRAPZ 
INTGER NPLOT 
CONST NPLOT=l 



* HYDRODYNAMIC COEFFICIENTS 



CONST NR=-0.00227,NV=-0.00351 ,NVO=-0. 000197 
CONST MYVD=0. 01,5 ,MYR = 0 .0051 , I ZNR0=0 . 000 78, MXJ0 = 0 . 0035 
CONST YV=-0.01243,XU=-0.0012, YRD=-0.0027 
CONST YDE LR = -C. 0027, \'DELR=- 0.001 26, XN=. 00005 



« RUDDER DEFLECTION 



PARAM 01=0.1 



INITIAL CONDITIONS 



INCON X0=0.,Y0=0. 



INI TIAL 



PARAM UD1=1. 



CALCULATION OF THE COEFFICIENTS 



A1 1 = MYVD 

B11=--YV 

A21=-YRD 

B21=MYR 

A12=-NVD 

B12=-NV 

A22=I ZNRD 

B22---NR 

A33=MXUD 

B33=-XU 

NC=-XU 

KA1=-YDELR 

KR1=N0ELR 

KC1=26 .-XN 

D=A1 1--:=A22-A12=^A21 

IFl = KAl=i'Dl 

IF2=K01=!<01 

1F3=KC J.«U01 
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DERIVATIVE 



# TIME DOMAIN SIMULATION 



I1=-B1 l*ADOT-B21*BDOT + IFl 

I2=-B1 Z^i'ADOT-BZZ^BDOT + IFZ 

I3=-B33*CD0T+-IF3 

ADDOT= ( I 1=^-A22- I2«A21 )/D 

BDDOT= ( I 2* A 11- 1 i«A12)/D 

CDDOT= I3/A33 

ADOT=I NTGRLIO. ,ADDOT) 

BDOT= INTGRLIO. , BDDOT) 

CDOT=INTGRL(l. ,CDDOT) 

A=1NTGRL (0. , ADOT) 

B=INTGRL(0.,BD0T) 

C=INTGRL(0. tCDCT ) 

XDOT=CDOT*CCS(B ) -ADOT«SIN( 8) 

YOOT = COOT=i=S IN(B ) +AOOT=!=COS { B ) 

X=INTGRL( XO,XOOT J 
Y=INTGRL( YO, YDOT) 

YAW=B 

SWAY=Y 

SURGE=X 

SAMPLE 

CONTRL FINTIM=30. ,DELT=0.04,DELS=0.04 
PREPAR 1. , SURGE, SWAY, YAW, USPEED 
GRAPH 7 I ME, YAW 
GRAPH TIME, SWAY 
GRAPH TIME,USPEEO 

GKAPFI Same, iu, iOjCsURijc, Sv'/AV,U3PEED 
PRPLOT CNLY 

CALL DRWGI 1,1, TIME, YAW) 

CALL ORWGv 2,1 , SURGE, SWAY) 

TERMINAL 

CALL ENDRWINPLOT ) 

END 

STOP 

//PLOT. STEPLIB DD OSN=SY S3 . DSLP LOT , UNI T=232 1 , VOL=SER=CE LOO 
//PLQT.SYSIN DO 



CM 



/AST02 JOB ( i025?0732iEA32) , ‘ASTORQUIZA* »TIME = 
/ EXEC FORTCLGP jREGI0N«G0=150K 
/FORT.SYSIN DO 
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//ASTOF JOB ( 1025, 0732, EA32 ), 'ASTORQUIZA* ,TIME=20 
// EXEC DSL, REGION. C=150K 
//DSL.FT06F001 DO SPAC £= ( TRK , ( 5 , 1 I) 

//DSL. INPUT 00 « 



COMPUTER PROGRAM III 



OPEN LOOP SYSTEM RESPONSE 



INTEG TRAPZ 
INTGER NPLOT 
CONST NPL0T=5 



HYDRODYNAMIC COEFFICIENTS 



PARAM MXUD=-0. 0085, XU = -0. 0012 
PA RAM MYR=-0. 0051 ,YRD=-0. 002 I 
PARAM YV=-0. 012^3,HVVD=-0.015 
PARAM NVD=-0. 00019 7 , NV=-0 . 0035 1 
PARAM NR=-0. 00227, I ZNRD=-0. 00078 
PARAM YDEL-0 .0027, NOEL =-0.00 126 
PARAM XN=. 00005 



INI I i A L CGiND I 7 1 ON 3 



INCON 


Y10 = 


“ c 


1 ,Y20 


= .l 


INC ON 


X10 = 


= 1. 


,X20 = 


0. 


INCON 


U10= 


= 1 . 


,U20 = 


1 . 


PARAM 


DDi = 


= 0. 


,DD2 = 


0. 


PARAM 


DN1 = 


= 0. 


, DN2 = 


0. 


PARAM 


YY1 = 


=0. 


, YY2 = 


0. , YN1=0. 


INITIAL 









, YN2=0, 



CALCULATION OF THE COEFFICIENTS 



A11=-MYV0 

B11=-YV 

A21=-YRD 

B21=-MYR 

C11=0. 

C12=0. 

C21=0. 

A12=-NVD 
B12=-NV 
A22=-I ZNRD 
B22=-NR 
C?2=0. 

A33=-MXUD 

B33=-XU 

P=A33/B33 

KC1=XN 

KK1=KC 1/B33 

KA=YDEL 

K8=MDEL 

0=A11*A22-AI2-‘^^A21 
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INITIAL SEPARATION 






DY0=Y20-Y10 

DX0=X20-X10 

CALL SLOPESIDXO, DYO ,YY1, YY2.YN1 ,YN2) 



DERIVATIVE 
« SIMULATION 



DX=X2-X1 

DY=Y2-Y1 

YDOTl = CDOTl*SIN( 81 )<-ADGTl=f=COS( 81 » 

YD0T2 = CD0T2-S1N( B2)+ADOT2-COS( 82) 

XCOTl = CDOTl*COS( 81 I-ADOTI-'^'SINI 31 ) 
XDOT2=CDCT2=i^COS I 82) -AOOT2=:'SIM( 82) 

AODl=( A22^=I 11-A21=!=[21 ) /O 
ADD2=( A22=^I12-A21=^'I22)/D 
BODl = ( A11=!^I21-A12*IU) /D 
8DD2 = ( A1 1=M2 2-A 12*1 12) /D 
ADOT1=INTGRL(0, , ADDl ) 

AOOT2= INTGRL (0. ,ADD2) 

BD0T1= INTGKLIO. i 8001 ) 

BD0T2= INTGRUO. ,8002 ) 

C01=REALPL( 0. ,P,KK1*0N1) 

CDOT1=U10+CD1 

CD0T2=U20 

A1=INTGRL(0.,AD0T1 ) 

A2=INTGRL (0. , ADOT2) 

B1=J. NTGRUO. ,BD0T1) 

B2=iNTGRL(0. ,BD0T2) 

Yl=INTGRL( YlO.YDOTl ) 

Y2=INTGRL(Y20,Y00T2) 

X1=INTGRL(X10,XD0T1) 

X2=INTGRL(X20,X0OT2) 

I 1 1=-B11*AOOT1-C1 1*AI-821*BD0T1-C21*BU- IFl 1 
1 12=-B 11*AD0T2-C ll*A2-R21*3DOT2-C21*B2-J-IFl 2 
I21=-3 12*AD0T1-C 12*A 1-822*8001 i-C22*Bl MF21 
I22 = -B12 *A(jOT 2-C 12* A2-B22* BOOT 2-C 22*B2<- I F2 2 
AFU = REALPL ( Oc ,0.1,KA*DD1) 

AF12-REALPLI0e ,0.1 ,KA*0D2) 

/.F21 = REALPL( 0. ,0. 1,K8*0D1) 

,AF22=REALPl (0. , 0. 1,KB*0D2) 

iFll = AFl U^YYl 

IF}.2 = AF12i-YY2 

I F21=AF2 l+YMl 

iF22=AF22+YN2 

eiG=57. 3*81 

B2G=57.3*B2 



DYNAMIC 

* ACTUAL SEPARATION 



DX=X2-X1 

DY=Y2-Y1 



CALL SLOPES ( OX, DV ,YYi,YY2, YNl ,YN2) 



I 



I 



( 





SAMPLE 

PRINT .036,DX,DY,YYl, YY2,YN1,YN2 ,BiG,B2G,Xi,X2 
PREPAR .0018, BIG, B2G,Y1 ,Y2 
CONTRL E I NT I M = 3. 2, DEL T=. 001 8, DELS =.00 18 
IF(ABS(DY) .LE.. 05) WRITE (6,3) 

3 FORMAT! • LATERAL SEPARATION LESS THAN 25 FT') 

CALL ORWG( 1 , 1 , T I ME, Y1 ) 

CALL DRWG(1,2,TIME,Y2) 

CALL DRWG(2,1,TIME,31G) 

CALL DRWG(2,2,TIME,B2G) 

TERMINAL 

CALL ENDRW (NPLOT) 

END 

INCON YIO=-. 1 ,Y20= . 1 
INCON U10=l. ,U20=1. 

PARAM X10=0. , X20=0. 

END 

PARAM Y10=-. 05,Y20=.05 ,X10=0. ,X20=0. 

END 

PARAM 020 = 1.2 ,Y10=-. 1 , Y20=. 1 ,X10= 1 . ,X20=0. 

END 

PARAM 020=1.2 ,Y10=-. 1 ,Y20=. 1 , XI 0=0 . , X 20=0. 

END 

STOP 

//C.SYSPRINT DD SP ACE= ( TRK , ( 2 , 2 ) ) 

//PLOT. STEPLIB DD DSN =SY S3 . DSL PLOT , ON I T=232 1 , VCL = SER=CE LOO 
//PLOT.SYSIN DD « 
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SUBROUTINE SLOPE S ( OX , OY , YY 1 , YY 2 , YNl , YN2 ) 



* 



TABLE LOOK-UP AND INTERPOLATION 



DIME NS ION Z( 23 , 16) ,W( 23, 16 ) ,X( 23 ) , Y( 16) 
X( 1)=-1.1 
X(2)=- 1. 

X(3)=- .9 
X(4)=-.8 
X(5)=- .7 
X(6)=- .6 
X(7)=-.5 
XI 8)=- .4 
X(9)=- .3 
X( 10)=-. 2 
X(ll)=-.l 
X( 12)=0. 

X( 13)=. 1 
X( 14)= .2 
X(15)=.3 
X( 16)= .4 
X(17)=.5 
X ( 1 8 I = . 6 
X( 19)= .7 
X( 20)= .8 
X( 21 )= .9 
X(22)=l. 

X(23) = l. 1 
Y( 1) = 0. 10 
Y(2)=0.12 
Y(3)=0.14 
Y(4)=0.16 
Y(5)=0.18 

Y / A ' — A o 

I % ^ 

Y( 7)=0 .22 
Y(8)=0.24 
Y( 9)=0.26 
Y( i0)=0.28 
Y( ii)=0.30 
Y( 12) = 0, 32 
Y( 13J=0.34 
Y( 14) =0.36 
Y( 15J=0,38 
Y(16)=0.40 
Z( 1, 1) =0. 

Za,2) =0, 

Z( 1,3) =0. 

Z( 1, 4) =0e 
za f 5) =0. 

Z( 1,6) =0. 

Z( 1,7) =0. 

Z{ 1,8) =0. 

Z ( 1, 9J =0. 

ZU,10) = 0. 

Z( i ,11 )=0. 

Z(1 , 12 )=0. 

Z{1,13 )=0. 

Z( 1, 14)=0. 

Z( 1,15J=0. 

Z ( 1 , 1 6 ) =0 . 

2(2, 1) =-24. 

Z(2, 2) =~21. 

Z ( 2 5 3 ) =- 1 9 . 

Z( 2, 4) =-21, 

Z(2, 5) =-15. 

Z ( 2 , 6 ) =- 1 4 . 

Z(2,7) =-12. 

Z( 2, 8) =-10o 

Z(2,9) =-8. 

Z(2, l0)=-6. 
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Z(2,ll)=-4. 
Z(2,12)=-2. 
Z(2,13 )=0. 
Z( 2, 14)=0. 
Z( 2, 15)=0. 
Z(2, 16)=0. 
Z(3»l) =-36. 
Z(3, 2) =-29. 
Z(3,3)=-26. 
Z(3,4) =-22. 
Z( 3, 5) =-18. 
Z(3,6)=-16, 
Z(3,7) =-14. 
Z(3, 8) =-12. 
Z(3,9) =-10. 
Z(3,10)=-8. 
Z(3,ll )=-6. 
Z(3,12)=-4. 
Z(3,13)=-2. 
Z(3,14)=0. 
Z(3,15)=0. 
Z(3, 16)=0. 
Z(4,l )=-39. 
Z{4,2) =-53. 
Z(4,3) =-28. 
Z(4,4) =-23. 
Z(4,5)=-18. 
Z( 4,6) =-16. 
Z(4, 7) =-14. 
Z(4,8)=-12. 
Z(4,9)=-10. 
Z(4,10)=-8. 
Z(4,ll )=-6. 
Z(4,12 )=-4. 
Z(4, 13 J=-2. 
^ 1 1 } = 0 . 
Z(4,15)=0. 
Z( 4, 16 ) =0. 
Z( 5, 1) =-38. 
Z(5,2)=-31. 
Z( 5, 3) =-26. 
Z( 5,4) =-2i . 
Z(5,5) =-18. 
Z(5,6) =-14. 
Z{5,7)=-12. 
Z(5,8) =-10. 
Z(5,9) =-8. 
Z( 5,10 )=-6. 
Z( 5, m=-4. 
2(5,1 2) =-2. 
Z(5,13)=0. 
Z( 5, 14)=0. 
2(5, 15 )=0. 
Z( 5, 16 )=0o 
2(6, 1) =-28. 
Z( 6, 2) =-24o 
Z(6,3) =-20. 
2(6, 4) =-15. 
2(6,5) =-12, 
2(6,6) =-10. 
2(6,7) =-8. 
2 ( 6 , 8 ) =- 6 „ 
2( 6,9) =-4. 
Z(6,i0)=-2. 

2(6, 11 )=0o 
2 ( 6 , 12 )= 0 . 
2 ( 6 , 1 3 )= 0 . 

2 ( 6, 14) =0. 
Z(6, 15 )=0. 
Z(6,16)=0. 
2(7, 1) =-l5. 
Z(7,2)=-ll. 
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Z( 7,3) =-9. 
Z(7,4) =-6. 

Z( 7, 5) =-4. 
Z(7,6)=-2. 
Z(7,7)=0. 

Z( 7, 8) =0. 
Z(7,9J=0. 
Z(7,10 )=0. 
Z(7,ll )=0. 
Z(7,12 J=0. 
Z(7,13 )=0. 
Z(7, 14)=0. 
Z(7,15)=0. 
Z(7,16)=0. 
Z(8, 1 J=4. 
Z(8,2)=6. 
Z(8,3) =7. 
Z(8,4) =8. 
Z(8,5)=9. 

Z( 8,6) =10. 
Z(8, 7)=7. 

Z( 8, 8) =6. 
Z(8,9)=4. 
Z(8,10)=2. 

Z( 8,11 )=0. 
Z<8,12)=0. 
Z(8,13)=0. 
Z(8,14)=0. 
Z(8,15)=0. 
Z(S,16)=0. 
Z(9, 1 )=27. 
Z(9,2) =25. 
Z(9, 3) =23. 
Z(9,4) =22. 
Z(9, 5) =21 . 

/ /-s r * , o 

L \ VjU / — iLU • 

Z ( 9 , 7 1 = i 8 , 
Z(9, 8) =16. 
Z(9,9) =14. 
Z(9, 10)=12. 
Z£9, 11 J=10. 
Z(9, 12 )=8. 
Z£9,13 )=6. 
Z(9, 14 )=4. 
Z(9, 15 )=2. 
Z(9, 16 )=0. 

Z( 10, 1)=52. 
Z( 10, 2)=47. 
Z( 10,3)=43. 
l( 10,4)=39. 
Z( 10, 5) =36. 
Z{ 10, 6 )=34. 
Z( 10, 7) =32. 
Z( 10, 8i=30. 
Z( i0,9)=28. 
Z( 10, 10) =26. 
Z( 10, 1 1)=24. 
Z( 10, 12)=22. 
Z( 10, 13) =20. 
Z£ 10, 14) =18. 
ZC 10, 15) =16. 
Z( 10, 16) = 14. 
Z{ 11, 1)=72. 
ZC li , 2 )=64, 
Z( 11,3)=58. 
Z(ll,4)=52. 
Z( Jl,5)=46. 
Z( 11,6)=43. 
Z{11,7)=40. 
ZC li,3)=37. 
Z( 11,9)=34. 

Z C 1 i , 1 0 ) = 3 1 - 
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Z( ll , m = 28. 
Z( 11 f 12)=25. 
Z( 11, 13)=22. 
Z( 11, 14)=19. 
Z( 11, 15)=17. 
Z( 11 , 16) = 15. 
Z( 12, 11=86. 
Z( 12,2) = 75. 
Z( 12,31=67. 
Z( 12,41=60. 
Z( 12, 51=53. 
Z( 12, 61=48. 
Z( 12,71=43. 
Z( 12, 31=39. 
Z( 12,91=35. 
Z( 12, 101 = 32. 
Z(12, 111=29. 
Z( 12, 121=26. 
Z( 12, 131=23. 
Z( 12,141=20. 
Z( 12, 151 = 18. 
Z( 12, 161=16. 
Z(13, 1 1=89. 
Z(13, 21=78. 
Z(13, 31=69. 
Z( 13, 4 1=60. 
Z(13, 51=53. 
Z( 13, 61=48. 
Z( 13, 71=43. 
Z( 13, 81=38. 
7(13,91=34. 
7(13,101=31 . 
7(13,111=28. 
7(13, 121=25. 
7(13,131=22. 

\ t L ^ i - L » 

7(15, 151 = 17. 
7(13,161=15. 
7(14,1 1=80. 
7( 14, 21=70. 
7(14,31=63. 
7(14,41=55, 
7( 14, 51=50. 
7(14,61=45. 
7(14,71=40. 
7(14,81 =36. 
7(14,91=33. 
7( 14, 101=30. 
7( 14, 111 = 29. 
7( 14,121=26. 
7(14, 131=23. 
7( 14, 141=20, 
7(14,151=18. 
7(14,161=16. 
7(15, 11=64. 
7(15,21=56, 
7( 15,31=51. 
7(15,41=46. 
7 ( 15 , 51 = 41 . 
7(15,61=38. 
7(15,71=36. 
70 5,8 1=34. 
Z( 15,91=32. 
7(15,101=30. 
7( 15, 111=28. 
7(15,121=26. 
7( 15, 131=24. 
7( 15,141=22. 
7( 15, 151 = 20. 
7(15,161=18. 
7(16,1 1=45. 
7(16,21=41. 
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Z( 16f 3 )=38. 
Z( 16,4)=35. 
Z( 16,5)=33. 
Z(16,6)=30. 
Z( 16, 7] =28. 
Z(16,8)=26. 
Z(16,9)=24. 
Z( 16, iO)=22 
Z( 16,11)=20 
Z( 16, 12)=18 
U 16, 13J = 16 
Z( 16, 14)=14 
Z{ 16, 15)=12 
Z( 16, 16) =10 
Z( 17, 1 )=30. 
Z(17,2)=28. 
Z( 17,3)=26. 
Z(17,4)=24. 
Z( 17,5)=23. 
Z( 17,6)=22. 
Z(17, 7 )=20. 
Z(17,8)=18. 
Z{ 17,9)=16. 
Z( 17, 10)=14 
Z( 17, 11) = 10 
Z( 17, 12)=10 
Z( 17, 13)=8. 
Z( 17, 14) =6. 
Z( 17, 1 5)=4. 
Z( 17, 16)=2. 
Z( 18, 1 )=17. 
Z(i8,2)=17. 
Z( 18,3)=16. 
Z( 18,4)=16. 
Zae, 5) = 16. 

\ lo i O ) - I o • 

Z(18,7)=15. 
Z ( 1 8 , 8 ) = 1 5 . 
Z ( 1 8 , 9 ) = I 5 . 
Z( 18, 10) = 14 
Z{ 18, li) = 14 
Z( 18, 12)=14 
Z(18, 13)=12 
Z( 18, 14)=12 
ZU8, 15) = 12 
Z( 18, 16)=10 
Z( 19, 1 )=6. 
Z(19,2 )=7. 
Z( 19,31=7. 
Z( 19,4)=8. 
Z()9,5)=8. 
Z< 19,61=9. 
Z{ 19, 71=9. 
Z( 19,8)=8. 
Z( 19,9 )=8. 
Z< 19, 10)=7. 
Z( 19, 1 1)=6. 
Z( 19, 12)=4. 
Z ( 1 9 , 1 3 ) = 5 . 
Zi 19, 14)=3. 
2(19, 15)=2. 
2(19,1 6)=0. 
Z(20, l)=-5. 
Z(20,2)=-4. 
2(20,3) =-3. 
Z(20,4)=-I. 
Z(20,5 ) = 0. 
2(20,61=0. 
Z( 20, 7 )=0. 
2(20, 8 {=0. 
Z(20,9)=0. 
Z(20, 10)=0. 



s 










Z(20,ll)=0. 
Z( 20, 1 2)=0. 
Z(20,13)=0. 
Z( 20, 14) =0. 
Z(20,15)=0. 
Z(20,16)=0. 
Z(21, I )=-5, 
Z(21,2J=-4. 
Z(21 , 3)=-3. 
Z(2i,4)=-1. 
Z(21,5)=0. 

Z( 21 ,6) =0. 
Z(21,7)=0. 

Z( 21 ,&)=0. 
Z(21 ,9)=0. 

Z( 21, 10)=0. 
Z( 21 ,1 1J=0. 
Z(21,12)=0. 
Z( 21 , 1 3)=0. 
Z(21 , 14)=0. 
Z(21,15)=0. 
Z( 21 , 16)=0. 
Z( 22, 1 )=-6. 
Z(22,2)=-5. 
Z(22, 3)=-5. 
Z(22,4)=-4. 
Z( 22,5) =-4. 
Z(22,6)=-4. 
Z(22,7)=-3. 
Z(22,8)=-3. 
Z( 22,9)=“2. 
Z(22, 10)=-2o 
Z(22, 1 1)=-1 . 
Z(22,12)=-l . 
Z(22,13)=~l . 
Z( 22, 14.‘=0. 
Z( 22, 15)=0. 
Z(22,16)=0. 
Z(23, 1 )=^0. 
Z(23,2)=0. 

Z( 23,3)=0. 
Z(23,4J^0. 
Z(23,5)-0. 

Z( 23,6)=0. 
Z(23, 7)=0. 
Z(23,8)=0. 
Z(23,9)=0. 
Z(23,10)=0. 
Z(23,ll)=0. 
Z( 23,12)=0. 
Z( 23, 13)=0. 
Z(23, 14)=0. 
Z(23, 1 5)=0. 
Z(23, 16)=0. 
U( 1,1)=0. 

W { i , 2 ) ==0 . 

W( 1,3) --=0. 

W( 1,4) =0. 
W{l,5)=0c 
K'{ 1,6) =0, 

W( 1,7) =0c 
W(l,8) -0. 

W( 1,9) =0. 
N{l,10)=0e 

WU , 11 )=0. 

W( i , 12 )=0. 

W( I ,13 )=0. 

W( 1,14)=0. 
W(l,15)=0. 

V)( 1 ,16 )=0, 

IV { 2 , 1 ) = 1 1 . 
W(2,2) =10. 
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W( 2,3} =10. 
W( 2,4)=9. 
W(2,5) =9. 

W( 2,6} =8. 
W(2,7} =6. 
W(2,8}=4. 

W( 2,9) =2. 
W(2, 10)=0. 
W(2,ll )=0. 
W{2,12)=0. 
W<2,13 ) = 0. 
W(2, 14)=0. 
W(2, 15 }=0. 
W( 2, 16 ) = 0. 
W(5, 1) =14. 
W(3,2) =14. 
W(3, 3} =11 . 
W( 3,4) =10. 
W(3,5) =9. 
W(3,6) =8. 
W(3,7)=7. 
W(3, 8) =6. 
VH3,9) =5. 

W( 3, 10 )=4. 

W ( 3 , 1 1 ) = 3 . 
W( 3, 12 ) =2. 
W( 3, 13 )=1 . 
W( 3, 14)=0. 
W(3,15)=0. 
W(3,16)=0. 
W(4, 1 }=14. 
W(4, 2) =12. 
W(4,3) =10. 
W(4,4) =8. 
W(/^,5) =7. 

W \ 4 , 6 i -6 * 
W(4, /) =5. 
W(4,8) =4. 
W(4,9) =3. 
W14, 10) =2. 
W(4, 11 )=1 . 
W(4,12)=0. 
W(4, 13 > =0. 
W(4, 14)=0. 

W ( 4 , 1 5 ) =0 . 
W(4,16)=0. 
W(5, 1) =10. 
W(5,2)=6. 

V)( 5, 3) =5. 
W(5,4) =4. 

W( 5, 5) =3. 

5,6) =2c 
W(5,7) =1. 

W ( 5 $ 8 ) =0 . 

W( 5,9) =0o 
W(5, 10)=0. 

W { 5 , 1 1 ) =0 . 
W(5,12)=0. 
W( 5,13 )=0. 
W(5,14)=0. 
W(5, 15)=0. 
W(5,16)=0. 
W( 6, i ) =-5, 
W(6,2! =-5. 
W( 0,3) =-4. 
U'(6,4)=-4. 
W(6, 5) =-4. 
W{6,6) =-4. 
W(6,7)=-3. 
W(6,0) =-3. 
W(6,9) =-3. 
W{6, 10)=-2. 
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W(6,11J 


=-2. 


W(6,12) 


= -l. 


W(6,13 ) 


=-l . 


W(6,14) 


= 0. 


W(6,15) 


= 0. 


W(6,16) 


= 0. 


W(7, 1) = 


-18. 


W(7,2)= 


-16. 


W(7,3) = 


-14. 


V/ ( 7 , 4 ) = 


-12. 


W(7,5) = 


-10. 


W ( 7 » 6 ) - 


-9. 


W(7,7) = 


-8. 


W(7,8) = 


-7. 


W( 7,9) = 


-6. 


W(7,10) 


=-5. 


W(7,ll) 


--4. 


W(7,12) 


=-3. 


W(7,13) 


= -2. 


W( 7,14) 


=-l. 


W(7,15) 


= 0. 


W(7,16) 


= 0. 


W{8,1) = 


-30. 


W(8,2) = 


-26. 


W(8,3) = 


-22. 


W(8,4)= 


-19. 


W(8,5) = 


-17. 


V.' ( 8 , 6 ) = 


-15. 


W{8,7)= 


-13. 


W ( 8 , 8 ) = 


-11 . 


W( 8,9) = 


-9. 


W { 8 , 1 0 ) 


=-7. 


W(8,ll ) 


=-5. 


W ( 8 , 1 2 ) 


=-3. 


W( 8, 13) 


=-l. 


W { 3 , 1 4 ) 


-0. 


W(8, 15) 


= 0. 


W{ 8,16 ) 


= 0. 


W( 9, 1) = 


-41 . 


W ( 9 , 2 > = 


-35. 


W{9,3) = 


-30. 


W( 9,4) = 


-25. 


W(9,5) = 


-22. 


W(9,6) = 


-18. 


W(9,7)= 


-16. 


( 9 , 8 ) = 


-14. 


W(9,9) = 


-12. 


W(9, 10) 


=-10. 


W ( 9 , 1 1 ) 


=-8. 


W ( 9 , 1 2 ) 


=-6. 


1 ; {9,15) 


=-4. 


W { 9 , 1 4 ) 


--—2. 


H ( 9 , 1 5 ) 


= 0. 


W{9, 16) 


= 0. 


W( 10 ,1 ) 


=-44. 


H( 10 , 2) 


= -38. 


W( 10,3) 


= -33. 


K'{ 10,4) 


=“28. 


va 1 0 , 5 ) 


=-25. 


w n 0 , 6 ) 


= -20 . 


W( 10,7) 


=-17. 


W( 10,8 ) 


=-14. 


w n. 0 , 9 ) 


=-n . 


W( 10, 10) =-9» 


10,1 1)^-7. 


vai0,12)=-5. 


W( 10, 13)=-3. 


W{ 10,14)=--2. 


W( 10, 15) =-l . 


W( 10, 16)=0. 


W ( 1 1 , 1 ) 


= — 43 . 


W( 11 ,2) 


=-37. 
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W( 11, 3)=-33. 
W(ll ,4)=-28. 
W( 11 ,5) 

W( 11 ,6J=-20. 
W( 11 ,7) =-17. 
W( 11 ,6 )=-14. 
W(ll ,9)=-ll . 
W( 11 , 10) =-9. 
W( 11 ,ll)=-7. 
W(ll,12)=-5. 
W( 11 , 13)=-5. 
W( 11 , 14)=-2. 
Wdl ,15)=-1 . 
W(ll,16)=0. 
W( 12,1 )=-37. 
W( 12,2)=-33. 
W( 12,3)=-30. 
W(12,4)=-26. 
W< 12,5)=-23. 
W( 12,6)=-20. 
W(12,7)=-17. 
W ( 1 2 , 8 ) =- 1 4 . 
W ( 1 2 , 9 ) =- 1 1 . 
W(12,10)=-9. 
W(12,ll)=-7. 
W( 12, 12)=-5. 
W(12,13)=-3, 
W( 12,14) =-2. 
WU2,15)=-1. 
W( 12 , 1 6) =0. 
W( 13. i)=-29. 
W(13,2)=~26. 
W(13,3)=-25. 
W( 13,4)=-22. 
W(13,5)=-19. 
W i 1 3 , 6 ) =- i 7 . 
W{ 13,7)=-15. 
W(13,8)=-13. 
W( i3,9)=-ll . 
H( 13 , 10)=-9. 
W(13,ll)=-7. 
W{13,12J=-5. 
W(13,13)=-3. 
W( 13,14)=-2. 
W(13,i5)=-l. 
W( 13,16)=0. 
W( 14, 1)=-18. 
W( 14, 2)=-16. 
W(14,3)=-16. 
W( 14,4)=“13, 
W( 14,5 )=~12. 
Wt 14,6)=- 10. 
W( 14; 7)=-9. 
W{ 14, 8)=-8. 
W( 14,9 )=-7. 
W( 14, 10)=-6. 
W(14,ll)=-5. 
W( 14,12) =-4. 
W( 14, 13)=-3. 
W( 14,145=-2. 
W(14,15)=-l. 
W( 14, 16) = 0. 
U(15,l )=-5. 
W( 15,2)=-4. 
W( 15,3)=“4. 
W( 15,4)=-4. 
W( 15,5)=-4. 

15 ,6 ) =— 4. 
W( 15,7 )=- 3. 
W( 15,8 )=-3. 
W( 15,9)=-3, 
W{ 15, 10)=-3. 



W( 15» 1 ii=-2 
W( 15, 1 2)=-2 
W( 15, I 3)=-i 
W( 15,14;=-! 
W( 15,15)=0. 
W( 15, 16)=0. 
W( 16, 1 )=-4. 
W(16,2)=-4. 
W( 16, 3) =-3. 
W( 16,4)=-3. 
W( 16,5)=-2. 
W( 16,6)=-2. 
W( 16,7;=-2. 
W( 16 ,8 ) =-l . 
W( 16,9)=-1. 
W( 16,10)=-1 
W( 16,li;=0. 
W( 16, I2i=0. 
W( 16, 13)=0. 
W( 16, 14)=0. 
W( 16, 15)=0. 
W(16,l 6)=0. 
W( 17, 1) = 11. 
W(17,2;=10. 
l>i(17,3)=9. 
W( 17,4)=8. 
W( 17,5 )=7o 
W( 17,6) =6. 
W( 17,7)=5. 
W( 17,8 )=4. 
W( 17,9)=3. 
W{ 17, io;=2. 
W{17,ll)=i. 
W( 17,12)=0. 
W( 17, 13)=0. 
W( 17,14)=0. 
W( 17 , 1 5)=0. 
W( 17, 1 6)=0. 
W( 18, 1 ) =14. 
W ( 1 8 , 2 ) = 1 2 . 
W( 18,3)=il. 
W( 18,4)=10. 
W(18,5)=9. 
W(18,6)=8. 
W( 1S,7)=6. 
W( 18,S)=4. 
W( 18,9)=2. 
W( 18, 10)=0. 
W( 18, 1 1 )=0. 
W( 18,12)=0. 
W(18, 13)=0. 
W( 18,14)=0. 
W{ 18, 15)=0. 
W( 18, 16)=0. 
W(19,U=13. 
W( 19, 2) =12, 
W( 19,3 )=10, 
W( 19,4)=10. 
W( 19, 5)=9. 
W(19,6)=8. 
W(19,7)=6. 
W(19,a;=4. 
W( 19,9 )=2 . 
W( 19,10)=0. 
W(i9,ll)=0. 
W( 19, 1 2) =0. 
W( 19,13)=0. 
Vm9,14) = 0. 
W( 19, 1 5)=0. 
W( 19, 165=0. 
H( 20, 1 5=12. 
W { 20 , 2 ; = 1 0 . 




I 



Wt20,3 )=9. 

W(20f4)=8. 

W(20,5)=7. 

W(20,6 )=7. 

W{ 20,7 ) =6. 

W( 20,3)=5. 

W( 20,9J =4. 

W( 20, 10)=3. 

W(20, 11)=2. 

W(20, i2) = l. 

W( 20, 13)=0. 

W(20,14)=0. 

W(20,15)=0. 

W( 20, 16) = 0. 

W( 21 , 1 )=10. 

W(21,2}=9. 

W( 21 ,3 )=7. 

W(21 ,4)=6. 

W(21 ,5)=5. 

W( 21 ,6 )=4. 

Kl 21,71=3. 

W(21,8)=2. 

W<2i,9J=l. 

WC21,10)=0. 

W<2i,ll)=^0. 

W{ 21 ,121=0. 

VH 21,1 3 )=0. 

21 , 14)=0. 

W( 21 , 15)=0. 

W( 21 ,16)=0. 

W122,l )=5. 

Wi22,2)=4. 

Wi22,3 )=3. 

W<22,4)=3. 

W<22,5i=2. 

W' < 2 2 , 6 ) - 2 . 

Wl 22 , 7 > = 1 . 

W{22,8)=i. 

W(22,9)=0. 

W( 22, I 0)=0. 

W(22,i 1 J=0. 

W( 22,121=0. 

22,151=0. 

22,141=0. 

VK22,1 51=0. 

1, ’(22, 161 = 0. 

K(23,l 1 =0. 

W( 23,21=0. 

W( 23,31=0. 
li(23,4J=0. 

W( 23, 5 1=0. 

Wl 23,61=0. 

WC23 ,71=0. 

W( 23,81=0. 

WC 23 ,91=0. 

Wl 23 , 1 0) =0. 

K{23, 111=0. 

23, 1.2 1=0. 

W( 23,1 31=0. 

W( 23, 141=0. 

W( 23,151=0. 

W123 , lol=0. 

IF( ABS(0Y1 .GE..47341 GO TO 1 

i = IFiX(( OX <-1.10021/. 1)^1. 

J=IFIX({DY-.ll/.021<-i. 

iF( J.LT. ilJ=l 

I F ( i . L T . 1 1 I = 1 

1F{ I .GT.23) 1=23 

iF( J .GTc 161J=16 

K=24-- ( 

0E1.X=DX-X( I 1 
Df:LY = DY-Y( J 1 
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OELK=OX-X(K) 

IF( ( I , EQ. 23) .OR. ( J.E0.16) J GO TO 2 

DYDl = OELX=!'( Z( H-1,J)-Z(I,J) )+DELY«(Z{ I , J 1 ) -Z ( I , J ) ) 

DYD2=D£LK’f^(Z(K<-l, J)-Z(K, J) ) ^-DE L Y=i‘ ( Z ( K , J + 1 ) -Z ( K , J ) ) 

DYNDl = DELX^( W( H-1,J)-W(I,J))+DELY<^(W(I,J+1J-W(I,J)) 

0YN02=0ELK=^(W(K-H, J )-W(K, J ) ) +DE LY» ( H ( K , J + 1 ) -W ( K , J ) ) 

YY1=(Z( I, J)+0Y01)*l.E-05 

YY2=-( Z( K, J J +-DY0 2)=!'l.E-05 

YN1 = (W( It J)+0YN01 )«l.E-05 

YN2=-( W(K, J)4-DYN02)^I.E-05 

RETURN 

1 YY1=0. 

YY2=0. 

YN1=0. 

YN2=0. 

RETURN 

2 YY1=Z( It J)-l.E-05 
YY2=-Z { Kt J) -1 .E-05 
YN1=W( I t J)*l.E-05 
YN2=-W( Kt J)-l.E-05 
RETURN 

END 
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//ASTOF JOB ( 1025, 0732, EA32) t'ASTORQUIZA' ,TIME=20 

// EXEC DSL, REGION. C=1 50K 

//DSL. FT06F001 DO SP AC E= ( TR K , ( 5 , I ) ) 

//DSL. INPUT DD # 



* COMPUTER PROGRAM IV 



« CONTROLLED PLANT RESPONSE 



INTEG TRAPZ 
INTGER NPLOT 
CONST NPL0T=2 



* HYDRODYNAMIC COEFFICIENTS 



PARAM MXUD=-0 .0085, XU=-0. 0012 
PARAM MYR=-0. 0051, YRD=-0. 0027 
PARAM YV=-0. 01243, MYV0=-0. 015 
PARAM NVD=-0.000197,NV=-0.00351 
PARAM NR=-0. 00227, I ZNR0=-0. 00078 
PARAM YDEL=0 .0027,NDEL=-0.00126 
PARAM XN=. 00005 
PARAM, TOP=-. 3490401396 



* INITIAL CONDITIONS 



INCON Y10=-.2,Y20=.2 

INCON X10=l. ,X20=0 

INCON U10=l. ,U20=1 .2 

PARAM DN1=0. , DN2=0 

PARAM YY1=0. ,YY2=0. , YN 1=0 . , YN2= 0. 



* DESIRED FINAL SEPARATION 



PARAM DFIN=.24 



« FEEDBACK LOOP GAINS 



PARAM K2=2.9l 7, KT2=2 . 042 , K1 =2. 9 75 ,KT1 =2. 775 
PARAM KY2=1.511 ,KTY2=2.878,KY1=3. 003 , KTYi=2. 783 



INITIAL 



# CALCULATION OF THE COEFFICIENTS 



A1 1=-MYVD 

B11=-YV 

A21=-YRD 

B21=-MYR 

CI1=0. 

C12=0. 

C21=0. 
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A12=-NV0 
B12=-NV 
A22=-I ZNRO 
B22=-NR 
C22=0. 

A33=-MXUD 

B33=-XU 

P=A33/B33 

KC1=XN 

KK1=KC1/B33 

KA=YDEL 

KB=NDEL 

D = A1 1^=A22-A12*A21 



* INITIAL SEPARATION 



0Y0=Y20-Y10 
DX0=X2 0-X10 



CALL SLOPES! DXO ,DYOtYYl, YY2 tYNl ,YN2 ) 



DERIVATIVE 



* SIMULATION 



DX=X2-X1 



OY=Y2-Yl 

YDOTl = CDOTi=^'SIN(Bl)+ADOTl*COS( B1 ) 
YDOT2=CDOT2*SIN ( B2 ) +ADOT2*COS ( 62 ) 

vnnvi— rnnxi'S:rnc/oi ^_Ar\oTiyi-CTM/oi \ 



XD0T2=CD0T2*C0S( B2)-ADOT2^SIN( B2) 



AD01=( A22^I 11- A2 1-121 )/D 
ADD2=( A22*I 12-A21=:'-I 22 ) /O 
BODl=( All^I 21-A12-I 1 1) /D 
B002=( Ali=M2 2-Ai2-I12)/Q 



AOOT1=INTGRL(0. ,ADD1 ) 

A00T2= INTGRLIO. t ADD2J 
BDOTl= INTGRLIO. , BDDl ) 

BD0T2= INTGRLCO. , BDD2) 

CD1 = REALPL(0. ,PtKK1=<=DN1) 

CDOT1=U10+CD1 
C02=REALPL(0. ,P ,KK1*DN2) 
CDOT2=NQRMA(OX,U20,CDOT1) 

A1=INTGRL(0, , AOOTl ) 

A2=INTGRL!0.,A00T2) 

B1=I NTGRL (0. , BDOTl ) 

B2=INTGRL(0. ,BD0T2) 

Y1=INTGRL!Y10,YDOT1) 

Y2=INTGRL(Y20, YD0T2) 

X1=1NTGRL(X10,XD0T1) 

X2=INTGRL! X20tX0OT2) 

I ll=-bll*ADOTl-C 11-A1-B21-BD0T l-C21*8UIFl 1 
1 12=-3 1 1«AD0T2-C ll*A2-821^BD0T2-C2i=!=B2*-IFl 2 
I21=-B12«AD0T1-C 12* A1-B22=!''BDCT1-C2 2*BI + IF21 
I22=-B12*ADOT2-C 12*A2-B22*BD0T2-C22*B2+IF22 



AF11=REALPL! 0. , 0. 1,KA*D01J 
AF12=REALPL(0. ,0.1 ,KA*D02) 
AF21=REALPL(0. ,0. 1,KB*D01 ) 
AF22=REALPL(0. ,0. 1,KB*0D2) 
IFl l=AFl l+YYl 
lF12=AF12fYY2 
IF21=AF2H-YN1 
IF22=AF22+YN2 



B1G=57.3*B1 

B2G=57.3*B2 

DYD0T=YD0T2-YD0T1 
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DDC=COURSE CONTROL ACTION 






« DDD=DISTANC£ CONTROL ACTION 



OOCl = Kl«BH-KTl*BDOTI 
DDD1=KY1*YU-KTY1«Y00T1 
DDC2=K2*B2+KT2^BOOT2 
0D02=KY2*(DY-DF IN )+KTY2*OYDOT 
001 = 0100(0001 , DOC I , TOP) 
C02=CARL0(D0C2, 0002, TOP) 
002G=DD2«57.3 
0010=001*57.3 



OYNAMIC 



* ACTUAL SEPARATION 



0X=X2-X1 

DY=Y2-Y1 



CALL SL0PES(0X,DY,YY1, YY2, YNl ,YN2) 

SAMPLE 

COMTRL FINTIM=24. ,0ELT=.013,0ELS=.013 
PREPAR .0I3,B1G,B2G,Y1 ,Y2,DD1G,0D2G 
PRINT .13,DX,0Y,YY1,YY2,YNI , YN2 , 3 1 G , B2G , X 1 , X2 
IF(ABS(DY) .LE..05)WRITE(6,3) 

3 FORMAT {• LATERAL SEPARATION LESS THAN 25 FT*) 
CALL u R W u i 1 , 1 , T I n E , Y 1 j 
CALL ORWG( 1 ,2,TIME,Y2) 

CALL ORWG( 2, 1, TIME,B1G) 

CALL DRWG(2,2,TIME,B2G) 

CALL DRWG(3,1 ,T IMEtOOlG) 

CALL 0RWG(3,2,TIME,D02G) 

TERMINAL 

CALL ENDRW (NPLOT) 

END 

PAR AH KY2=1. 533 , KTY2= 2 . 60 8 , KY 1=3 . 32 , K TY 1=2. 5 55 

PARAM K2=2.853,KT2=2.141 ,K1=3.069 ,KT1=3.08 

INCON Y10=-. 18,Y20=. 18 

PARAM DFIN=.3 

ENO 

STOP 



FORTRAN 



FUNCTION N0RMA(0X ,U20,CDOTI ) 
CDOT2=U20 

IF( ABS( DX) .LE. .005) C00T2=C00T1 

N0RMA=CD0T2 

RETURN 

ENO 



FUNCTION OIOOIDDCl ,0001 , TOP ) 

DD1=DDC1+D0D1 
IF(001. LT.TOP) 0D1=T0P 
0100=001 
RETURN 
END 
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FUNCTION CARLO(DDC2,ODD2,TOP) 



DD2=DDC2+DDD2 

IF(DD2. LT .TOP) 0D2=T0P 

CARLO=OD2 

RETURN 

END 



//C.SYSPRINT DD SPACE= < TRK» ( 2 , 2 ) ) 

//PLOT. STEPLI B DO 0SN = SYS3 .DSL PLOT , UN I T = 232 1 , VOL=SER = CELOO 
//PLOT.SYSIN DD * 



1 1 5 



//ASTOF JOB ( 1025,0732, EA32) , 'ASTORQUIZA* ,TIME=20 

// EXEC DSL .REGION. C=150K 

//DSL. FT06F001 DD SPACE= ( TRK , ( 5 , 1 ) ) 

//DSL. INPUT DD * 



♦ COMPUTER PROGRAM V 



« CONTROLLED PLANT RESPONSE 



INTEG TRAPZ 
INTGER NPLOT 
CONST NPL0T=4 



* HYDRODYNAMIC COEFFICIENTS 



PARAM MXUD=-0 .0085, XU=-0. 0012 
PARAM MYR=-0. 0051 ,YRD=-0. 0027 
PARAM YV=-0. 01243, MYVD=-0. 015 
PARAM NVD=-0. 000197, NV=-0. 00351 
PARAM NR=-0. 00227, I ZNRD=-0.00078 
PARAM YDEL=0. 0027, NDEL=-0. 00126 
PARAM XN=. 00005 
PARAM TOP=— .3490401396 



INITIAL CONDITIONS 



INCON Y10=-. 18,Y20=. 18 

INCON X10=l« ,X20=0 

INCON U10=l. ,U20=1.2 

PARAM DN1=0. , DN2=0 

PARAM YY1=0. , YY2=0, ,YN1=0. , YN2=0. 



* DESIRED FINAL SEPARATION 



PARAM DFIN=.3 



* QUASI-OPTIMAL FEEDBACK LOOP GAINS 



PARAM KY2=1. 533 , KTY 2=2 . 608 , KY 1 =3 . 32 , K TY 1 =2 . 5 5 5 
PARAM K2=2.853,KT2=3.21 15,K1=3.059,KT1=4.62 



INI TIAL 



CALCULATION OF THE COEFFICIENTS 



A1 1=-MYVD 

B11=-YV 

A21=-YRD 

B21=-MYR 

C11=0. 

Cl 2=0. 

C21=0. 
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A12=-NVD 
B12=-NV 
A22=-I ZNRO 
B22=-NR 
C22=0. 

A33=-MXUO 

B33=-XU 

P=A33/B33 

KC1=XN 

KK1=KC 1/B33 

KA=YDEL 

KB=NDEL 

D=A11=«^A22-A12*A21 



« INITIAL SEPARATION 



0Y0=Y20-Y10 

DX0=X20-X10 



CALL SLOPE S ( DXO, DY0,YY1,YY2,YN It YN2) 



DERIVATIVE 



* SIMULATION 



DX=X2-Xl 

OY=Y2-Yl 

YDOTl = CDOTl=.''SIN( B1 ) + ADOTl*COS( BI) 

YOOT2 = CDOT2^'SIN( B2UADOT2^=COS( B2 j 
XDGT1-CD0T1-;'C[J5 { 81 - ADOTl * S I N ( B i ) 
XOOT2=CDOT2^CUS ( B2 ) - ADOT2=!= S I N ( B2) 

ADD1={ A22=i-'I 11-A21*I 21 ) /D 
ADD2=( A22*I 12-A21-i=I22)/0 
BDD1 = { All=i=I21-A12*lll)/D 
BOD2=( AL1^I22-Al2=i^l 12 j /D 
ADOTl= INTGRLIO. t AODl ) 

ADDT2=INTGRL(0. , AOD2) 

BDOTl= INTGRL(0. , 3DD1 ! 

BD0T2=INTGRL(0. , B0D2 ) 

CD1=REALPL( 0. ,P , KKl^ONl) 

CDOT1=U10+CD1 
CD2=REALPL( 0. , PtKKKDN2) 
CDOT2=NORMA{DX,U20,CDOT1 ) 

A1=INTGRL(0. tAOOTl ) 

A2=INTGRL(0. ,A00T2) 

B1=INTGRL(0. ,B00T1) 

B2=IMTGRL10. ,B00T2) 

Yl=INTGRL{Y10,YDGTl) 

Y2=INTGRL(Y20,Y00T2) 

X1 = I NTGRLC X] OtXDOTl ) 

X2=INTGRL{X20,XDOT2> 

I ll=-811*ADOTl--Cll-Al-B2l*EDOT 1-C21*BH IF1 1 
I 12=-B11=^AD0T2-C 1 A2- B2 1 * BOOT 2-C 21 ^'-d 2 v I F 1 2 
I21=-B12*AD0T1-C 12=!=Al-B22*BD0T]-C22^3H-lF2i 
122=-B12^'‘ADaT2-C l2'-^A2-822’:=B00T2-C22-J=B2i-iF2 2 
AF11=REALPL ( 0. ,0. ItKA-KDDl ) 

AF12=REALPL(0. ,0. l,KA-002} 

AF21=REALPL(0. ,0.1|KB-00i ) 

AF22-REALPL ( 0. ,0.1,KB*0D2) 

IFl 1=AF1 1+VYl 

IF12=AF12^-YY2 

IF21 = AF2U-YN1 

IF22=AF22<-YM2 

B1G=57.3#B1 

B2G=57.3*B2 

DYD0T=YD0T2-YD0T1 
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DDC=COURSE CONTROL ACTION 



* 



=«= DDD=DISTANCE CONTROL ACTION 



ODC1=K1*B1+KT1*BDOTI 
DDDl=KYl*Yl+KTYl=i=YDOTl 
ODC2 = K2-'!=B2 + KT2*BDOT2 
DDD2=KY2*(OY-DF IN)+KTY2*DYDOT 
DDl=DIOO(DODl ,DDC l,TOP ) 
DD2=CARLO( DOC2,DDD2, TOP) 
D02G=DD2*57.3 
DDlG=DDi=i^57.3 



DYNAMIC 



* ACTUAL SEPARATION 



OX=X2-Xl 

DY=Y2-Y1 



CALL SLOPES(DX,DY,YYl,YY2, YNl ,YN2) 

SAMPLE 

CONTRL F I NT I M = 24. , DELT= . 013 » DELS= . 01 3 
PR E PAR .013 ,B1G,B2G,Y1,Y2,0D1G,DD2G 
PRINT . 13,0X,DY,YY1,YY2,YN1 ,YN2,B1G,B2G,X1,X2 
IF(ABS(DY) .LE. .05)WRITEI 6,3) 

3 FORMAT! * 'LATERAL SEPARATION LESS THAN 25 FT') 

/'All 1 TT»4rr v/1% 

I L J I I JL J 

CALL DRWG ( 1 , 2 , T I ME » Y 2 ) 

CALL DRWG (2,1, TIME, BIG) 

CALL DRWG(2,2,TIME,B2G) 

TERMINAL 

CALL ENDRW (NPLOT) 

END 

PAR AM K2=2. 85 3 ,KT2=2 . 1 4 1 , Kl=3 . 069 , KT 1 =4. 62 

PAR AM KY2=1. 533 , KT Y2 =2 . 608 , KY1= 3 . 32 , K TY 1=3 . 832 5 

END 

PAR AM K2=2.853,KT2=2. 141 ,K1=3.069,KT1=4. 62 

PA RAM KY2=1.91625,KTY2=2.608,KYl=3.32,KTYi=3.8325 

END 

PAR AM K2=2.853,KT2=2. 141 ,K 1=3. 52935, KT 1=4. 62 
PARAM KY2=1,9 i625,KTY2=2.608vKYl=3.32,KTYl=3. 8325 
END 
STOP 



FORTRAN 



FUNCTION N0RHA(DX,U20,CD0T1 ) 
CD0T2=U20 

IF(ABS(DX) .LE..005) CDOT2=CDOTl 

NORMA=CDOT2 

REl URN 

END 
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FUNCTION DIDOIDDCl ,0001, TOP) 



DC1=D0C1+0001 
IF(OOl.LT.TOP) 001=T0P 
0100=001 
RETURN 
ENO 



FUNCTION CARLO(OOC2, 0002, TOP) 

0D2 = D0C2^■0002 

IFI002.lt. TOP) 002=T0P 

CARL0=002 

RETURN 

ENO 



//C.SYSPRINT 00 
//PLOT. STEPLIB 
//PLOT.SYSIN 00 



SPACE— {TRK (2 2)) 

DO DSN = SYS3. DSL PLOT, UN I T = 232 1 , VO L=S ER = CELOO 
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